trying to fix wrong direction right left

Ensmasteel · Apr 30, 2024 · 7da58f1 · 7da58f1
1 parent 92daf12
commit 7da58f1
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/src/omnidirectional_controllers/src/kinematics.cpp b/src/omnidirectional_controllers/src/kinematics.cpp
@@ -61,9 +61,9 @@ std::vector<double> Kinematics::getWheelsAngularVelocities(RobotVelocity vel) {
   double wl = vel.omega * robot_params_.robot_radius;
 
   angular_vel_vec_[0] = (wl + vy) / robot_params_.wheel_radius;
-  angular_vel_vec_[1] = (wl - vx) / robot_params_.wheel_radius;
+  angular_vel_vec_[1] = -(wl - vx) / robot_params_.wheel_radius;
   angular_vel_vec_[2] = (wl - vy) / robot_params_.wheel_radius;
-  angular_vel_vec_[3] = (wl + vx) / robot_params_.wheel_radius;
+  angular_vel_vec_[3] = -(wl + vx) / robot_params_.wheel_radius;
 
   return angular_vel_vec_;
 }