I want go to sea
Dependencies: arrc_mbed Servo air
Diff: main.cpp
- Revision:
- 5:1506bf89f48e
- Parent:
- 4:7e2aa008f84b
diff -r 7e2aa008f84b -r 1506bf89f48e main.cpp --- a/main.cpp Fri Apr 01 00:23:31 2022 +0000 +++ b/main.cpp Fri Apr 08 09:29:59 2022 +0000 @@ -58,20 +58,22 @@ tim=timer.read_ms(); a=0; } - if(!limitC==0){ - a=1; - } - if(timer.read_ms()-tim<1000){ + if(timer.read_ms()-tim<500){ hassya.move(0); driveMotorS2(0); Servo(1); - }else if(timer.read_ms()-tim<2000){ + }else if(timer.read_ms()-tim<1000){ hassya.move(1); driveMotorS2(0); Servo(0); - }else if(timer.read_ms()-tim>2000 && a==0){ + }else if((timer.read_ms()-tim>1000 && !limitC==0) || a==1){ + hassya.move(0); + driveMotorS2(0); + Servo(0); + a=1; + }else if(timer.read_ms()-tim>1000 && a==0){ hassya.move(1); - driveMotorS2(-0.15); + driveMotorS2(-0.1); Servo(0); }else{ hassya.move(0);