Ganti Pin tx rx
Dependencies: Motor PID Joystick_OrdoV5 mbed
Fork of Joystick_ManualV2_hapusSeluruhEncoder by
Diff: main.cpp
- Revision:
- 19:bb304933a9f8
- Parent:
- 18:23412e950394
- Child:
- 20:31b3bdb17007
diff -r 23412e950394 -r bb304933a9f8 main.cpp --- a/main.cpp Wed Jan 18 10:28:01 2017 +0000 +++ b/main.cpp Wed Jan 18 14:08:37 2017 +0000 @@ -42,7 +42,7 @@ float speed2=0.6; float speed3=0.6; float speed4=0.6; -float speedB=0.43 ; +float speedB=0.23 ; float speedL=0.4; @@ -65,7 +65,7 @@ // Inisialisasi Pin TX-RX Joystik dan PC joysticknucleo joystick(PA_0,PA_1); -Serial pc(USBTX,USBRX); +Serial pc(PA_2,PA_3); //encoder variable float errX, errY, errT, Vt, Vx, Vy; @@ -647,7 +647,7 @@ { // Set baud rate - 115200 joystick.setup(); - pc.baud(115200); + pc.baud(57600); wait_ms(500); pc.printf("Ready...\n"); @@ -677,6 +677,9 @@ if (joystick.lingkaran_click){ ServoGo = true; } + if (joystick.silang) { + pc.printf("Depan = %.3f \t Belakang = %.3f \n",speedB,speedL); + } speedLauncher(); } else {