diff --git a/DifferentialDrive.cpp b/DifferentialDrive.cpp index 3b1aabe..3d432be 100644 --- a/DifferentialDrive.cpp +++ b/DifferentialDrive.cpp @@ -47,11 +47,12 @@ void DifferentialDrive::SetMotorTargetSpeeds(float leftSpeed, }; } +#include void DifferentialDrive::SetTwistSpeed(float forward, float yaw) { float leftSpeed = - Float::Clamp(forward - yaw, -1, 1); // revolutions per second - float rightSpeed = Float::Clamp(forward + yaw, -1, 1); // revolutions per second + float rightSpeed = + Float::Clamp(forward - yaw, -1, 1); // revolutions per second float leftMotorSpeed = leftSpeed / rpsToMs; // meters per second float rightMotorSpeed = rightSpeed / rpsToMs; // meters per second