标题: 简易步进控制 [打印本页]

作者: sanlingdao    时间: 2021-10-19 11:16
标题: 简易步进控制
本帖最后由 sanlingdao 于 2021-10-19 14:37 编辑



int _ABVAR_1_step1;//步数初值
int _ABVAR_2_;//步数变量
bool _ABVAR_3_A;//状态寄存
void setup()
{
_ABVAR_1_step1 = 0;
//_ABVAR_3_A = false;
pinMode( 5 , INPUT);//sinner
pinMode( 3 , OUTPUT);//plus
pinMode( 4 , OUTPUT);//dir
}

void loop()
{
_ABVAR_1_step1 = 1750;
if ((digitalRead( 5)) && !( _ABVAR_3_A ))
{
digitalWrite( 4 , HIGH );
for (_ABVAR_2_=0; _ABVAR_2_< ( ( _ABVAR_1_step1 - 1 ) ); ++_ABVAR_2_ )
{
digitalWrite( 3 , HIGH );
delay( 1 );
digitalWrite( 3 , LOW );
}
_ABVAR_3_A = true;
}
delay( 1000 );

if (!( digitalRead( 5))  && (_ABVAR_3_A ))
{
digitalWrite( 4 , LOW );
for (_ABVAR_2_=0; _ABVAR_2_< ( ( _ABVAR_1_step1 - 1 ) ); ++_ABVAR_2_ )
{
digitalWrite( 3 , HIGH );
delay( 1 );
digitalWrite( 3 , LOW );
}
_ABVAR_3_A = false;
}
delay( 1000 );

}







欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1