转起来了

This commit is contained in:
2023-05-30 08:35:35 +08:00
parent 0fad22f86e
commit fd09f48ac2
+34 -19
View File
@@ -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();
}