Commit 4557ff9f authored by 957dd's avatar 957dd

加入了谁坦克的控制

parent 28919483
No preview for this file type
...@@ -12,37 +12,37 @@ void tank0206_mode_lift_flont(unsigned char gval) { ...@@ -12,37 +12,37 @@ void tank0206_mode_lift_flont(unsigned char gval) {
if (gval < 50) { if (gval < 50) {
pwmWrite(PWM_PIN_SPEED, 75); pwmWrite(PWM_PIN_SPEED, 75);
} else if (gval <= 55) { } else if (gval <= 55) {
pwmWrite(PWM_PIN_SPEED, 78); pwmWrite(PWM_PIN_SPEED, 76);
} else if (gval <= 60) { } else if (gval <= 60) {
pwmWrite(PWM_PIN_SPEED, 79); pwmWrite(PWM_PIN_SPEED, 77);
} else if (gval <= 65) { } else if (gval <= 65) {
pwmWrite(PWM_PIN_SPEED, 80); pwmWrite(PWM_PIN_SPEED, 78);
} else if (gval <= 70) { } else if (gval <= 70) {
pwmWrite(PWM_PIN_SPEED, 81); pwmWrite(PWM_PIN_SPEED, 79);
} else if (gval <= 75) { } else if (gval <= 75) {
pwmWrite(PWM_PIN_SPEED, 82); pwmWrite(PWM_PIN_SPEED, 80);
} else if (gval <= 90) { } else if (gval <= 90) {
pwmWrite(PWM_PIN_SPEED, 83); pwmWrite(PWM_PIN_SPEED, 81);
} else if (gval <= 100) { } else if (gval <= 100) {
pwmWrite(PWM_PIN_SPEED, 84); pwmWrite(PWM_PIN_SPEED, 82);
} else if (gval <= 110) { } else if (gval <= 110) {
pwmWrite(PWM_PIN_SPEED, 85); pwmWrite(PWM_PIN_SPEED, 83);
} else if (gval <= 120) { } else if (gval <= 120) {
pwmWrite(PWM_PIN_SPEED, 86); pwmWrite(PWM_PIN_SPEED, 84);
} else if (gval <= 130) { } else if (gval <= 130) {
pwmWrite(PWM_PIN_SPEED, 87); pwmWrite(PWM_PIN_SPEED, 85);
} else if (gval <= 140) { } else if (gval <= 140) {
pwmWrite(PWM_PIN_SPEED, 88); pwmWrite(PWM_PIN_SPEED, 86);
} else if (gval <= 150) { } else if (gval <= 150) {
pwmWrite(PWM_PIN_SPEED, 89); pwmWrite(PWM_PIN_SPEED, 87);
} else if (gval <= 160) { } else if (gval <= 160) {
pwmWrite(PWM_PIN_SPEED, 90); pwmWrite(PWM_PIN_SPEED, 88);
} else if (gval <= 170) { } else if (gval <= 170) {
pwmWrite(PWM_PIN_SPEED, 91); pwmWrite(PWM_PIN_SPEED, 89);
} else if (gval <= 180) { } else if (gval <= 180) {
pwmWrite(PWM_PIN_SPEED, 92); pwmWrite(PWM_PIN_SPEED, 90);
} else if (gval <= 190) { } else if (gval <= 190) {
pwmWrite(PWM_PIN_SPEED, 93); pwmWrite(PWM_PIN_SPEED, 91);
} else if (gval <= 200) { } else if (gval <= 200) {
pwmWrite(PWM_PIN_SPEED, 94); pwmWrite(PWM_PIN_SPEED, 94);
} }
...@@ -52,37 +52,37 @@ void tank0206_mode_lift_back(unsigned char gval) { ...@@ -52,37 +52,37 @@ void tank0206_mode_lift_back(unsigned char gval) {
if (gval < 50) { if (gval < 50) {
pwmWrite(PWM_PIN_SPEED, 75); pwmWrite(PWM_PIN_SPEED, 75);
} else if (gval <= 55) { } else if (gval <= 55) {
pwmWrite(PWM_PIN_SPEED, 72); pwmWrite(PWM_PIN_SPEED, 74);
} else if (gval <= 60) { } else if (gval <= 60) {
pwmWrite(PWM_PIN_SPEED, 71); pwmWrite(PWM_PIN_SPEED, 73);
} else if (gval <= 65) { } else if (gval <= 65) {
pwmWrite(PWM_PIN_SPEED, 70); pwmWrite(PWM_PIN_SPEED, 72);
} else if (gval <= 70) { } else if (gval <= 70) {
pwmWrite(PWM_PIN_SPEED, 69); pwmWrite(PWM_PIN_SPEED, 71);
} else if (gval <= 75) { } else if (gval <= 75) {
pwmWrite(PWM_PIN_SPEED, 68); pwmWrite(PWM_PIN_SPEED, 70);
} else if (gval <= 90) { } else if (gval <= 90) {
pwmWrite(PWM_PIN_SPEED, 67); pwmWrite(PWM_PIN_SPEED, 69);
} else if (gval <= 100) { } else if (gval <= 100) {
pwmWrite(PWM_PIN_SPEED, 66); pwmWrite(PWM_PIN_SPEED, 68);
} else if (gval <= 110) { } else if (gval <= 110) {
pwmWrite(PWM_PIN_SPEED, 65); pwmWrite(PWM_PIN_SPEED, 67);
} else if (gval <= 120) { } else if (gval <= 120) {
pwmWrite(PWM_PIN_SPEED, 64); pwmWrite(PWM_PIN_SPEED, 66);
} else if (gval <= 130) { } else if (gval <= 130) {
pwmWrite(PWM_PIN_SPEED, 63); pwmWrite(PWM_PIN_SPEED, 65);
} else if (gval <= 140) { } else if (gval <= 140) {
pwmWrite(PWM_PIN_SPEED, 62); pwmWrite(PWM_PIN_SPEED, 64);
} else if (gval <= 150) { } else if (gval <= 150) {
pwmWrite(PWM_PIN_SPEED, 61); pwmWrite(PWM_PIN_SPEED, 63);
} else if (gval <= 160) { } else if (gval <= 160) {
pwmWrite(PWM_PIN_SPEED, 60); pwmWrite(PWM_PIN_SPEED, 62);
} else if (gval <= 170) { } else if (gval <= 170) {
pwmWrite(PWM_PIN_SPEED, 59); pwmWrite(PWM_PIN_SPEED, 61);
} else if (gval <= 180) { } else if (gval <= 180) {
pwmWrite(PWM_PIN_SPEED, 58); pwmWrite(PWM_PIN_SPEED, 60);
} else if (gval <= 190) { } else if (gval <= 190) {
pwmWrite(PWM_PIN_SPEED, 57); pwmWrite(PWM_PIN_SPEED, 59);
} else if (gval <= 200) { } else if (gval <= 200) {
pwmWrite(PWM_PIN_SPEED, 56); pwmWrite(PWM_PIN_SPEED, 56);
} }
...@@ -92,37 +92,37 @@ void tank0206_mode_right_flont(unsigned char gval) { ...@@ -92,37 +92,37 @@ void tank0206_mode_right_flont(unsigned char gval) {
if (gval < 50) { if (gval < 50) {
pwmWrite(PWM_PIN_CHANGE, 75); pwmWrite(PWM_PIN_CHANGE, 75);
} else if (gval <= 55) { } else if (gval <= 55) {
pwmWrite(PWM_PIN_CHANGE, 78); pwmWrite(PWM_PIN_CHANGE, 76);
} else if (gval <= 60) { } else if (gval <= 60) {
pwmWrite(PWM_PIN_CHANGE, 79); pwmWrite(PWM_PIN_CHANGE, 77);
} else if (gval <= 65) { } else if (gval <= 65) {
pwmWrite(PWM_PIN_CHANGE, 80); pwmWrite(PWM_PIN_CHANGE, 78);
} else if (gval <= 70) { } else if (gval <= 70) {
pwmWrite(PWM_PIN_CHANGE, 81); pwmWrite(PWM_PIN_CHANGE, 79);
} else if (gval <= 75) { } else if (gval <= 75) {
pwmWrite(PWM_PIN_CHANGE, 82); pwmWrite(PWM_PIN_CHANGE, 80);
} else if (gval <= 90) { } else if (gval <= 90) {
pwmWrite(PWM_PIN_CHANGE, 83); pwmWrite(PWM_PIN_CHANGE, 81);
} else if (gval <= 100) { } else if (gval <= 100) {
pwmWrite(PWM_PIN_CHANGE, 84); pwmWrite(PWM_PIN_CHANGE, 82);
} else if (gval <= 110) { } else if (gval <= 110) {
pwmWrite(PWM_PIN_CHANGE, 85); pwmWrite(PWM_PIN_CHANGE, 83);
} else if (gval <= 120) { } else if (gval <= 120) {
pwmWrite(PWM_PIN_CHANGE, 86); pwmWrite(PWM_PIN_CHANGE, 84);
} else if (gval <= 130) { } else if (gval <= 130) {
pwmWrite(PWM_PIN_CHANGE, 87); pwmWrite(PWM_PIN_CHANGE, 85);
} else if (gval <= 140) { } else if (gval <= 140) {
pwmWrite(PWM_PIN_CHANGE, 88); pwmWrite(PWM_PIN_CHANGE, 86);
} else if (gval <= 150) { } else if (gval <= 150) {
pwmWrite(PWM_PIN_CHANGE, 89); pwmWrite(PWM_PIN_CHANGE, 87);
} else if (gval <= 160) { } else if (gval <= 160) {
pwmWrite(PWM_PIN_CHANGE, 90); pwmWrite(PWM_PIN_CHANGE, 88);
} else if (gval <= 170) { } else if (gval <= 170) {
pwmWrite(PWM_PIN_CHANGE, 91); pwmWrite(PWM_PIN_CHANGE, 89);
} else if (gval <= 180) { } else if (gval <= 180) {
pwmWrite(PWM_PIN_CHANGE, 92); pwmWrite(PWM_PIN_CHANGE, 90);
} else if (gval <= 190) { } else if (gval <= 190) {
pwmWrite(PWM_PIN_CHANGE, 93); pwmWrite(PWM_PIN_CHANGE, 91);
} else if (gval <= 200) { } else if (gval <= 200) {
pwmWrite(PWM_PIN_CHANGE, 94); pwmWrite(PWM_PIN_CHANGE, 94);
} }
...@@ -132,37 +132,37 @@ void tank0206_mode_right_back(unsigned char gval) { ...@@ -132,37 +132,37 @@ void tank0206_mode_right_back(unsigned char gval) {
if (gval < 50) { if (gval < 50) {
pwmWrite(PWM_PIN_CHANGE, 75); pwmWrite(PWM_PIN_CHANGE, 75);
} else if (gval <= 55) { } else if (gval <= 55) {
pwmWrite(PWM_PIN_CHANGE, 71); pwmWrite(PWM_PIN_CHANGE, 74);
} else if (gval <= 60) { } else if (gval <= 60) {
pwmWrite(PWM_PIN_CHANGE, 70); pwmWrite(PWM_PIN_CHANGE, 73);
} else if (gval <= 65) { } else if (gval <= 65) {
pwmWrite(PWM_PIN_CHANGE, 70); pwmWrite(PWM_PIN_CHANGE, 72);
} else if (gval <= 70) { } else if (gval <= 70) {
pwmWrite(PWM_PIN_CHANGE, 70); pwmWrite(PWM_PIN_CHANGE, 71);
} else if (gval <= 75) { } else if (gval <= 75) {
pwmWrite(PWM_PIN_CHANGE, 69); pwmWrite(PWM_PIN_CHANGE, 70);
} else if (gval <= 90) { } else if (gval <= 90) {
pwmWrite(PWM_PIN_CHANGE, 68); pwmWrite(PWM_PIN_CHANGE, 69);
} else if (gval <= 100) { } else if (gval <= 100) {
pwmWrite(PWM_PIN_CHANGE, 68); pwmWrite(PWM_PIN_CHANGE, 68);
} else if (gval <= 110) { } else if (gval <= 110) {
pwmWrite(PWM_PIN_CHANGE, 66); pwmWrite(PWM_PIN_CHANGE, 67);
} else if (gval <= 120) { } else if (gval <= 120) {
pwmWrite(PWM_PIN_CHANGE, 65); pwmWrite(PWM_PIN_CHANGE, 66);
} else if (gval <= 130) { } else if (gval <= 130) {
pwmWrite(PWM_PIN_CHANGE, 64); pwmWrite(PWM_PIN_CHANGE, 65);
} else if (gval <= 140) { } else if (gval <= 140) {
pwmWrite(PWM_PIN_CHANGE, 62); pwmWrite(PWM_PIN_CHANGE, 64);
} else if (gval <= 150) { } else if (gval <= 150) {
pwmWrite(PWM_PIN_CHANGE, 60); pwmWrite(PWM_PIN_CHANGE, 63);
} else if (gval <= 160) { } else if (gval <= 160) {
pwmWrite(PWM_PIN_CHANGE, 59); pwmWrite(PWM_PIN_CHANGE, 62);
} else if (gval <= 170) { } else if (gval <= 170) {
pwmWrite(PWM_PIN_CHANGE, 58); pwmWrite(PWM_PIN_CHANGE, 61);
} else if (gval <= 180) { } else if (gval <= 180) {
pwmWrite(PWM_PIN_CHANGE, 57); pwmWrite(PWM_PIN_CHANGE, 60);
} else if (gval <= 190) { } else if (gval <= 190) {
pwmWrite(PWM_PIN_CHANGE, 56); pwmWrite(PWM_PIN_CHANGE, 59);
} else if (gval <= 200) { } else if (gval <= 200) {
pwmWrite(PWM_PIN_CHANGE, 55); pwmWrite(PWM_PIN_CHANGE, 55);
} }
...@@ -171,22 +171,30 @@ void tank0206_mode_right_back(unsigned char gval) { ...@@ -171,22 +171,30 @@ void tank0206_mode_right_back(unsigned char gval) {
void tank0206_change(unsigned char *buf) { void tank0206_change(unsigned char *buf) {
unsigned char mode = buf[1]; unsigned char mode = buf[1];
unsigned char val = buf[2]; unsigned char val = buf[2];
static int modecount_tank0206=0;
if(mode == 1 ) { if(mode == 1 ) {
tank0206_mode_lift_flont(val); //tank0203_mode_lift_flont(val);
tank0206_mode_right_flont(val); tank0206_mode_right_flont(val);
modecount_tank0206=0;
}else if(mode == 2 ) { }else if(mode == 2 ) {
tank0206_mode_lift_back(val); //tank0203_mode_lift_back(val);
tank0206_mode_right_back(val); tank0206_mode_right_back(val);
modecount_tank0206=1;
} }
if((mode == 1||mode ==2)&&val == 0) modecount_tank0206=0;
if(mode == 3) { if(mode == 3) {
//tank0206_mode_lift_flont(val); if(modecount_tank0206 == 0) tank0206_mode_lift_flont(val+10);
tank0206_mode_lift_back(val); if(modecount_tank0206 == 1) tank0206_mode_lift_back(val+10);
}else if(mode == 4) { }else if(mode == 4) {
//tank0206_mode_lift_back(val); if(modecount_tank0206 == 0) tank0206_mode_lift_back(val+10);
tank0206_mode_right_flont(val); if(modecount_tank0206 == 1) tank0206_mode_lift_flont(val+10);
} }
} }
Markdown is supported
0% or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment