diff --git a/motorControl.ino b/motorControl.ino index 743be63..1869c87 100644 --- a/motorControl.ino +++ b/motorControl.ino @@ -76,7 +76,7 @@ void motors() { //Turn controller - TC_cont_out = PController(rem_turn_speed_ref, vel_Matrix[0][1], K_TC); + TC_cont_out = PController(rem_turn_speed_ref, vel_Matrix[1][0], K_TC); //Sum speed command for motors