base ultimate + line following HYBRID
Dependencies: ESC Motor PS_PAD hadah mbed Ping
Fork of Ultimate_Hybrid by
Diff: main.cpp
- Revision:
- 5:256f6eac0358
- Parent:
- 4:7a7a8aa33fd5
diff -r 7a7a8aa33fd5 -r 256f6eac0358 main.cpp --- a/main.cpp Wed Apr 27 14:28:05 2016 +0000 +++ b/main.cpp Thu Apr 28 13:56:52 2016 +0000 @@ -174,12 +174,17 @@ //if(read_jarak() <= 45.0) vcurr -= ax; //else vcurr += ax; vcurr += ax; - } + + for(int i=0; i<6; i++){ + printf("%d ",datasensor[i]); + } + printf("%d \n",g_flag); + } - motor1.brake(1); - motor2.brake(1); - motor3.brake(1); - motor4.brake(1); + motor1.brake(0); + motor2.brake(0); + motor3.brake(0); + motor4.brake(0); timer.detach();