diff --git a/src/homemade_controller/src/forward_kinematics.cpp b/src/homemade_controller/src/forward_kinematics.cpp index 9e49206..171e4a3 100644 --- a/src/homemade_controller/src/forward_kinematics.cpp +++ b/src/homemade_controller/src/forward_kinematics.cpp @@ -24,7 +24,7 @@ ForwardKinematics::~ForwardKinematics(){ std::vector ForwardKinematics::getWheelsAngularVelocities(double vx, double vy, double omega){ double wl = omega * wheel_base_; - + // this needs verification angular_vel_vec_[0] = (wl + vy) / wheel_radius_; angular_vel_vec_[1] = (wl - vx) / wheel_radius_; angular_vel_vec_[2] = (wl - vy) / wheel_radius_;