测试代码
This commit is contained in:
@@ -0,0 +1 @@
|
|||||||
|
.vs*
|
||||||
@@ -8,15 +8,68 @@
|
|||||||
#define W_N 33
|
#define W_N 33
|
||||||
#define W_P 32
|
#define W_P 32
|
||||||
|
|
||||||
|
#define EN_C 19
|
||||||
|
|
||||||
|
void motomove(int step)
|
||||||
|
{
|
||||||
|
switch(step)
|
||||||
|
{
|
||||||
|
case 0:
|
||||||
|
digitalWrite(U_N, 1);
|
||||||
|
digitalWrite(U_P, 0);
|
||||||
|
digitalWrite(V_N, 1);
|
||||||
|
digitalWrite(V_P, 0);
|
||||||
|
digitalWrite(W_N, 1);
|
||||||
|
digitalWrite(W_P, 0);
|
||||||
|
break;
|
||||||
|
case 1:
|
||||||
|
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 3:
|
||||||
|
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:
|
||||||
|
digitalWrite(U_N, 1);
|
||||||
|
digitalWrite(U_P, 0);
|
||||||
|
digitalWrite(V_N, 0);
|
||||||
|
digitalWrite(V_P, 0);
|
||||||
|
digitalWrite(W_N, 1);
|
||||||
|
digitalWrite(W_P, 0);
|
||||||
|
break;
|
||||||
|
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
void setup() {
|
void setup() {
|
||||||
// put your setup code here, to run once:
|
// put your setup code here, to run once:
|
||||||
|
|
||||||
|
//moto pin mode
|
||||||
pinMode(U_N, OUTPUT);
|
pinMode(U_N, OUTPUT);
|
||||||
pinMode(U_P, OUTPUT);
|
pinMode(U_P, OUTPUT);
|
||||||
pinMode(V_N, OUTPUT);
|
pinMode(V_N, OUTPUT);
|
||||||
pinMode(V_P, OUTPUT);
|
pinMode(V_P, OUTPUT);
|
||||||
pinMode(W_N, OUTPUT);
|
pinMode(W_N, OUTPUT);
|
||||||
pinMode(W_P, OUTPUT);
|
pinMode(W_P, OUTPUT);
|
||||||
|
//encode pin mode
|
||||||
|
pinMode(EN_C,INPUT_PULLUP);
|
||||||
|
|
||||||
|
|
||||||
digitalWrite(U_N, 1);
|
digitalWrite(U_N, 1);
|
||||||
@@ -26,16 +79,34 @@ void setup() {
|
|||||||
digitalWrite(W_N, 1);
|
digitalWrite(W_N, 1);
|
||||||
digitalWrite(W_P, 0);
|
digitalWrite(W_P, 0);
|
||||||
|
|
||||||
|
|
||||||
Serial.begin(115200);
|
Serial.begin(115200);
|
||||||
Wire.begin();
|
Wire.begin();
|
||||||
OLED_Init();
|
OLED_Init();
|
||||||
|
|
||||||
|
OLED_Str(0,0,16,"test",0,1);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
int ii=0;
|
||||||
|
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)
|
||||||
|
{
|
||||||
|
OLED_Str(0,0,16,"push",0,1);
|
||||||
|
ii+=1;
|
||||||
|
if(ii==5){ii=0;}
|
||||||
|
}else
|
||||||
|
{
|
||||||
OLED_Str(0,0,16,"test",0,1);
|
OLED_Str(0,0,16,"test",0,1);
|
||||||
|
ii=0;
|
||||||
|
}
|
||||||
|
sprintf(srt,"index:%d",ii);
|
||||||
|
OLED_Str(0,16,16,srt,0,1);
|
||||||
|
motomove(ii);
|
||||||
|
delay(10);
|
||||||
|
|
||||||
OLED_Cache_to_hardware();
|
OLED_Cache_to_hardware();
|
||||||
//OLED_Init();
|
//OLED_Init();
|
||||||
|
|
||||||
|
|||||||
@@ -132,7 +132,7 @@ void OLED_Cache_to_hardware()
|
|||||||
|
|
||||||
}else
|
}else
|
||||||
{b=0;}
|
{b=0;}
|
||||||
OLED_buff[y][x]=0x00;
|
//OLED_buff[y][x]=0x00;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user