@@ -62,28 +62,29 @@ bool AckermannSteeringController::update_odometry(const rclcpp::Duration & perio
62
62
}
63
63
else
64
64
{
65
- const double rear_right_wheel_value = state_interfaces_[STATE_TRACTION_RIGHT_WHEEL].get_value ();
66
- const double rear_left_wheel_value = state_interfaces_[STATE_TRACTION_LEFT_WHEEL].get_value ();
67
- const double front_right_steer_position =
68
- state_interfaces_[STATE_STEER_RIGHT_WHEEL].get_value ();
69
- const double front_left_steer_position = state_interfaces_[STATE_STEER_LEFT_WHEEL].get_value ();
65
+ const double traction_right_wheel_value =
66
+ state_interfaces_[STATE_TRACTION_RIGHT_WHEEL].get_value ();
67
+ const double traction_left_wheel_value =
68
+ state_interfaces_[STATE_TRACTION_LEFT_WHEEL].get_value ();
69
+ const double right_steer_position = state_interfaces_[STATE_STEER_RIGHT_WHEEL].get_value ();
70
+ const double left_steer_position = state_interfaces_[STATE_STEER_LEFT_WHEEL].get_value ();
70
71
if (
71
- !std::isnan (rear_right_wheel_value ) && !std::isnan (rear_left_wheel_value ) &&
72
- !std::isnan (front_right_steer_position ) && !std::isnan (front_left_steer_position ))
72
+ !std::isnan (traction_right_wheel_value ) && !std::isnan (traction_left_wheel_value ) &&
73
+ !std::isnan (right_steer_position ) && !std::isnan (left_steer_position ))
73
74
{
74
75
if (params_.position_feedback )
75
76
{
76
77
// Estimate linear and angular velocity using joint information
77
78
odometry_.update_from_position (
78
- rear_right_wheel_value, rear_left_wheel_value, front_right_steer_position ,
79
- front_left_steer_position , period.seconds ());
79
+ traction_right_wheel_value, traction_left_wheel_value, right_steer_position ,
80
+ left_steer_position , period.seconds ());
80
81
}
81
82
else
82
83
{
83
84
// Estimate linear and angular velocity using joint information
84
85
odometry_.update_from_velocity (
85
- rear_right_wheel_value, rear_left_wheel_value, front_right_steer_position ,
86
- front_left_steer_position , period.seconds ());
86
+ traction_right_wheel_value, traction_left_wheel_value, right_steer_position ,
87
+ left_steer_position , period.seconds ());
87
88
}
88
89
}
89
90
}
0 commit comments