转起来了
This commit is contained in:
+34
-19
@@ -26,35 +26,50 @@ void motomove(int step)
|
||||
digitalWrite(U_N, 0);
|
||||
digitalWrite(U_P, 0);
|
||||
digitalWrite(V_N, 1);
|
||||
digitalWrite(V_P, 0);
|
||||
digitalWrite(W_N, 1);
|
||||
digitalWrite(W_P, 1);
|
||||
break;
|
||||
case 2:
|
||||
digitalWrite(U_N, 1);
|
||||
digitalWrite(U_P, 0);
|
||||
digitalWrite(V_N, 1);
|
||||
digitalWrite(V_P, 1);
|
||||
digitalWrite(W_N, 1);
|
||||
digitalWrite(W_P, 0);
|
||||
break;
|
||||
case 2:
|
||||
digitalWrite(U_N, 0);
|
||||
digitalWrite(U_P, 0);
|
||||
digitalWrite(V_N, 1);
|
||||
digitalWrite(V_P, 0);
|
||||
digitalWrite(W_N, 1);
|
||||
digitalWrite(W_P, 1);
|
||||
break;
|
||||
case 3:
|
||||
digitalWrite(U_N, 1);
|
||||
digitalWrite(U_P, 0);
|
||||
digitalWrite(V_N, 0);
|
||||
digitalWrite(V_P, 0);
|
||||
digitalWrite(W_N, 1);
|
||||
digitalWrite(W_P, 1);
|
||||
break;
|
||||
case 4:
|
||||
digitalWrite(U_N, 1);
|
||||
digitalWrite(U_P, 1);
|
||||
digitalWrite(V_N, 0);
|
||||
digitalWrite(V_P, 0);
|
||||
digitalWrite(W_N, 1);
|
||||
digitalWrite(W_P, 0);
|
||||
break;
|
||||
case 5:
|
||||
digitalWrite(U_N, 1);
|
||||
digitalWrite(U_P, 1);
|
||||
digitalWrite(V_N, 1);
|
||||
digitalWrite(V_P, 0);
|
||||
digitalWrite(W_N, 0);
|
||||
digitalWrite(W_P, 0);
|
||||
break;
|
||||
case 4:
|
||||
case 6:
|
||||
digitalWrite(U_N, 1);
|
||||
digitalWrite(U_P, 0);
|
||||
digitalWrite(V_N, 0);
|
||||
digitalWrite(V_P, 0);
|
||||
digitalWrite(W_N, 1);
|
||||
digitalWrite(V_N, 1);
|
||||
digitalWrite(V_P, 1);
|
||||
digitalWrite(W_N, 0);
|
||||
digitalWrite(W_P, 0);
|
||||
break;
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
@@ -92,22 +107,22 @@ char srt[64];
|
||||
void loop() {
|
||||
// put your main code here, to run repeatedly:
|
||||
|
||||
if(digitalRead(EN_C)==0)
|
||||
if(1)
|
||||
{
|
||||
OLED_Str(0,0,16,"push",0,1);
|
||||
ii+=1;
|
||||
if(ii==5){ii=0;}
|
||||
if(ii==7){ii=1;}
|
||||
}else
|
||||
{
|
||||
OLED_Str(0,0,16,"test",0,1);
|
||||
ii=0;
|
||||
}
|
||||
sprintf(srt,"index:%d",ii);
|
||||
OLED_Str(0,16,16,srt,0,1);
|
||||
//sprintf(srt,"index:%d",ii);
|
||||
//OLED_Str(0,16,16,srt,0,1);
|
||||
motomove(ii);
|
||||
delay(10);
|
||||
delay(7);
|
||||
|
||||
OLED_Cache_to_hardware();
|
||||
//OLED_Cache_to_hardware();
|
||||
//OLED_Init();
|
||||
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user