set firmware units

Signed-off-by: Jakub Delicat <jakub.delicat@pwr.edu.pl>
This commit is contained in:
Jakub Delicat 2024-01-18 17:02:56 +01:00
parent 2534b906d5
commit 664091048d

View File

@ -17,10 +17,10 @@ sensor_msgs::msg::JointState Ros2Aria::handleWheels(rclcpp::Time stamp)
wheels.name[0] = "left_wheel_joint";
wheels.name[1] = "right_wheel_joint";
wheels.position[0] = encoder_to_rad(r->getLeftEncoder());
wheels.position[1] = encoder_to_rad(r->getRightEncoder());
wheels.velocity[0] = mm_per_sec_to_rad_per_sec(r->getLeftVel());
wheels.velocity[1] = mm_per_sec_to_rad_per_sec(r->getRightVel());
wheels.position[0] = r->getLeftEncoder();
wheels.position[1] = r->getRightEncoder();
wheels.velocity[0] = r->getLeftVel();
wheels.velocity[1] = r->getRightVel();
return wheels;
}