kevin/motorcontrol_esp32
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

转起来了

Browse Source
This commit is contained in:
kevin
2023-05-30 08:35:35 +08:00
parent 0fad22f86e
commit fd09f48ac2
1 changed files with 34 additions and 19 deletions
Download Patch File Download Diff File Expand all files Collapse all files
demo1/demo1.ino
+34 -19
View File
@@ -26,35 +26,50 @@ void motomove(int step)
digitalWrite(U_N, 0); digitalWrite(U_N, 0);
digitalWrite(U_P, 0); digitalWrite(U_P, 0);
digitalWrite(V_N, 1); 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(V_P, 1);
digitalWrite(W_N, 1); digitalWrite(W_N, 1);
digitalWrite(W_P, 0); digitalWrite(W_P, 0);
break; 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: case 3:
digitalWrite(U_N, 1); 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(U_P, 1);
digitalWrite(V_N, 1); digitalWrite(V_N, 1);
digitalWrite(V_P, 0); digitalWrite(V_P, 0);
digitalWrite(W_N, 0); digitalWrite(W_N, 0);
digitalWrite(W_P, 0); digitalWrite(W_P, 0);
break; break;
case 4: case 6:
digitalWrite(U_N, 1); digitalWrite(U_N, 1);
digitalWrite(U_P, 0); digitalWrite(U_P, 0);
digitalWrite(V_N, 0); digitalWrite(V_N, 1);
digitalWrite(V_P, 0); digitalWrite(V_P, 1);
digitalWrite(W_N, 1); digitalWrite(W_N, 0);
digitalWrite(W_P, 0); digitalWrite(W_P, 0);
break; break;
} }
} }
@@ -92,22 +107,22 @@ char srt[64];
void loop() { void loop() {
// put your main code here, to run repeatedly: // put your main code here, to run repeatedly:
if(digitalRead(EN_C)==0) if(1)
{ {
OLED_Str(0,0,16,"push",0,1); OLED_Str(0,0,16,"push",0,1);
ii+=1; ii+=1;
if(ii==5){ii=0;} if(ii==7){ii=1;}
}else }else
{ {
OLED_Str(0,0,16,"test",0,1); OLED_Str(0,0,16,"test",0,1);
ii=0; ii=0;
} }
sprintf(srt,"index:%d",ii); //sprintf(srt,"index:%d",ii);
OLED_Str(0,16,16,srt,0,1); //OLED_Str(0,16,16,srt,0,1);
motomove(ii); motomove(ii);
delay(10); delay(7);
OLED_Cache_to_hardware(); //OLED_Cache_to_hardware();
//OLED_Init(); //OLED_Init();
} }