Fixed ticks calculation equation

iRobotEducation · Dec 12, 2023 · 025d10d · 025d10d
1 parent fa3d501
commit 025d10d
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/irobot_create_common/irobot_create_nodes/src/wheels_publisher.cpp b/irobot_create_common/irobot_create_nodes/src/wheels_publisher.cpp
@@ -76,10 +76,10 @@ void WheelsPublisher::publisher_callback()
 
     // Calculate and write WheelTicks msg
     const double left_ticks =
-      (get_dynamic_state_value("left_wheel_joint", "position") / wheel_circumference_) *
+      (get_dynamic_state_value("left_wheel_joint", "position") / (2 * M_PI)) *
       encoder_resolution_;
     const double right_ticks =
-      (get_dynamic_state_value("right_wheel_joint", "position") / wheel_circumference_) *
+      (get_dynamic_state_value("right_wheel_joint", "position") / (2 * M_PI)) *
       encoder_resolution_;
 
     wheel_ticks_msg_.ticks_left = std::round(left_ticks);