Skip to content

Use new handles API in ros2_controllers to fix deprecation warnings #1566

New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

Sign up for GitHub

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Open
wants to merge 54 commits into
base: master
Choose a base branch
from
Open

Use new handles API in ros2_controllers to fix deprecation warnings #1566

Show file tree
Hide file tree
Changes from 3 commits
Commits
Show all changes
54 commits
Select commit Hold shift + click to select a range
0bf0670
Fix deprecation warnings with use of new handles API in ackermann_ste…
kumar-sanjeeev Mar 2, 2025
1466fdc
Fix deprecation warnings with use of new handles API in bicycle_steer…
kumar-sanjeeev Mar 3, 2025
a447f31
Fix typo
kumar-sanjeeev Mar 3, 2025
d356e08
Fix deprecation warnings with use of new handles API in admittance_co…
kumar-sanjeeev Mar 5, 2025
e4f6aef
Fix deprecation warnings with use of new handles API in effort_contro…
kumar-sanjeeev Mar 5, 2025
44dcfcb
Fix deprecation warnings with use of new handles API in force_torque_…
kumar-sanjeeev Mar 5, 2025
39200aa
Fix deprecation warnings with use of new handles API in forward_comma…
kumar-sanjeeev Mar 5, 2025
0c044b8
Fix deprecation warnings with use of new handles API in gpio_controllers
kumar-sanjeeev Mar 5, 2025
3b4685e
Add more descriptive message for warning
kumar-sanjeeev Mar 5, 2025
12d9639
Change return from ERROR to SUCCESS to make it work in sychronous cal…
kumar-sanjeeev Mar 5, 2025
9592271
Fix deprecation warnings with use of new handles API in gripper_contr…
kumar-sanjeeev Mar 5, 2025
704096b
Fix deprecation warnings with use of new handles API in joint_state_b…
kumar-sanjeeev Mar 5, 2025
214dcd1
Fix deprecation warnings with use of new handles API in mecanum_drive…
kumar-sanjeeev Mar 5, 2025
eaec22b
Fix deprecation warnings with use of new handles API in parallel_grip…
kumar-sanjeeev Mar 5, 2025
a64136a
Fix deprecation warnings with use of new handles API in tricycle_cont…
kumar-sanjeeev Mar 7, 2025
bf43abd
Merge branch 'ros-controls:master' into fix_warnings_in_controllers/n…
kumar-sanjeeev Mar 15, 2025
663a131
Fix deprecation warnings with use of new handles API in velocity_comt…
kumar-sanjeeev Mar 16, 2025
2ef6d10
Fix deprecation warnings with use of new handles API in pid_controller
kumar-sanjeeev Mar 31, 2025
6628b14
Fix deprecation warnings with use of new handles API in mecanum_drive…
kumar-sanjeeev Mar 31, 2025
31d574c
Fix deprecation warnings with use of new handles API in tricycle_stee…
kumar-sanjeeev Mar 31, 2025
85a06ce
Merge branch 'master' into fix_warnings_in_controllers/new_api
christophfroehlich Apr 16, 2025
116cf22
Merge remote-tracking branch 'upstream/master' into fix_warnings_in_c…
kumar-sanjeeev May 11, 2025
96736c6
Fix deprecation warnings with use of new handles API in steering_cont…
May 11, 2025
9af0948
Discard implemented changes to resolve conflict
kumar-sanjeeev May 11, 2025
5d5567e
Fix deprecation warnings with use of new handles API in position_cont…
kumar-sanjeeev May 11, 2025
764ff05
Fix deprecation warnings with use of new handles API in diff_drive_co…
kumar-sanjeeev May 11, 2025
374538f
Fix [partially] deprecation warnings with use of new handles API in j…
kumar-sanjeeev May 11, 2025
4a45a4b
Merge remote-tracking branch 'origin/master' into fix_warnings_in_con…
christophfroehlich May 17, 2025
a465cef
Update effort_controllers/src/joint_group_effort_controller.cpp
kumar-sanjeeev Jun 8, 2025
f8acfba
Update forward_command_controller/src/forward_controllers_base.cpp
kumar-sanjeeev Jun 8, 2025
7f8a4f0
Update gpio_controllers/src/gpio_command_controller.cpp
kumar-sanjeeev Jun 8, 2025
93a09ee
Update velocity_controllers/src/joint_group_velocity_controller.cpp
kumar-sanjeeev Jun 8, 2025
b59a111
Update tricycle_controller/src/tricycle_controller.cpp
kumar-sanjeeev Jun 8, 2025
95e9a23
Update tricycle_steering_controller/src/tricycle_steering_controller.cpp
kumar-sanjeeev Jun 8, 2025
ef39442
Update tricycle_controller/src/tricycle_controller.cpp
kumar-sanjeeev Jun 8, 2025
f5b3d30
Update tricycle_controller/src/tricycle_controller.cpp
kumar-sanjeeev Jun 8, 2025
86299a4
Update tricycle_controller/src/tricycle_controller.cpp
kumar-sanjeeev Jun 8, 2025
8faa405
Update steering_controllers_library/src/steering_controllers_library.cpp
kumar-sanjeeev Jun 8, 2025
a2a5024
Update steering_controllers_library/src/steering_controllers_library.cpp
kumar-sanjeeev Jun 8, 2025
d8529e2
Update parallel_gripper_controller/include/parallel_gripper_controlle…
kumar-sanjeeev Jun 8, 2025
085e2f5
Update joint_trajectory_controller/src/joint_trajectory_controller.cpp
kumar-sanjeeev Jun 8, 2025
6c865a5
Update forward_command_controller/src/forward_controllers_base.cpp
kumar-sanjeeev Jun 8, 2025
f382dbb
Update joint_trajectory_controller/src/joint_trajectory_controller.cpp
kumar-sanjeeev Jun 8, 2025
4c18e85
Update parallel_gripper_controller/include/parallel_gripper_controlle…
kumar-sanjeeev Jun 8, 2025
895ad29
Update parallel_gripper_controller/include/parallel_gripper_controlle…
kumar-sanjeeev Jun 8, 2025
c2d6b5c
Update parallel_gripper_controller/include/parallel_gripper_controlle…
kumar-sanjeeev Jun 8, 2025
14c672a
Update joint_trajectory_controller/src/joint_trajectory_controller.cpp
kumar-sanjeeev Jun 8, 2025
b473a22
Update mecanum_drive_controller/src/mecanum_drive_controller.cpp
kumar-sanjeeev Jun 8, 2025
4ce4139
Update joint_trajectory_controller/src/joint_trajectory_controller.cpp
kumar-sanjeeev Jun 8, 2025
330818c
steering_controllers_library/src/steering_controllers_library.cpp
kumar-sanjeeev Jun 9, 2025
fa07219
Remove return statement
kumar-sanjeeev Jun 10, 2025
b387a61
Code formatting pre-commit check
kumar-sanjeeev Jun 10, 2025
38c9e4a
Remove return statement
kumar-sanjeeev Jun 10, 2025
db48e13
Update return type from void to bool
kumar-sanjeeev Jun 12, 2025
File filter

Filter by extension

Filter by extension
Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
33 changes: 27 additions & 6 deletions ackermann_steering_controller/src/ackermann_steering_controller.cpp
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -56,18 +56,39 @@ controller_interface::CallbackReturn AckermannSteeringController::configure_odom

bool AckermannSteeringController::update_odometry(const rclcpp::Duration & period)
{
auto logger = get_node()->get_logger();

if (params_.open_loop)
{
odometry_.update_open_loop(last_linear_velocity_, last_angular_velocity_, period.seconds());
}
else
{
const double traction_right_wheel_value =
state_interfaces_[STATE_TRACTION_RIGHT_WHEEL].get_value();
const double traction_left_wheel_value =
state_interfaces_[STATE_TRACTION_LEFT_WHEEL].get_value();
const double steering_right_position = state_interfaces_[STATE_STEER_RIGHT_WHEEL].get_value();
const double steering_left_position = state_interfaces_[STATE_STEER_LEFT_WHEEL].get_value();
const auto traction_right_wheel_value_op =
state_interfaces_[STATE_TRACTION_RIGHT_WHEEL].get_optional();
const auto traction_left_wheel_value_op =
state_interfaces_[STATE_TRACTION_LEFT_WHEEL].get_optional();
const auto steering_right_position_op =
state_interfaces_[STATE_STEER_RIGHT_WHEEL].get_optional();
const auto steering_left_position_op = state_interfaces_[STATE_STEER_LEFT_WHEEL].get_optional();

if (
!traction_right_wheel_value_op.has_value() || !traction_left_wheel_value_op.has_value() ||
!steering_right_position_op.has_value() || !steering_left_position_op.has_value())
{
RCLCPP_DEBUG(
logger,
"Unable to retrieve the data from right wheel or left wheel or right steering position or "
"left steering position!");

return true;
}

const double traction_right_wheel_value = traction_right_wheel_value_op.value();
const double traction_left_wheel_value = traction_left_wheel_value_op.value();
const double steering_right_position = steering_right_position_op.value();
const double steering_left_position = steering_left_position_op.value();

if (
std::isfinite(traction_right_wheel_value) && std::isfinite(traction_left_wheel_value) &&
std::isfinite(steering_right_position) && std::isfinite(steering_left_position))
Expand Down
52 changes: 26 additions & 26 deletions ackermann_steering_controller/test/test_ackermann_steering_controller.cpp
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -143,9 +143,9 @@ TEST_F(AckermannSteeringControllerTest, reactivate_success)
ASSERT_EQ(controller_->on_configure(rclcpp_lifecycle::State()), NODE_SUCCESS);
ASSERT_EQ(controller_->on_activate(rclcpp_lifecycle::State()), NODE_SUCCESS);
ASSERT_EQ(controller_->on_deactivate(rclcpp_lifecycle::State()), NODE_SUCCESS);
ASSERT_TRUE(std::isnan(controller_->command_interfaces_[0].get_value()));
ASSERT_TRUE(std::isnan(controller_->command_interfaces_[0].get_optional().value()));
ASSERT_EQ(controller_->on_activate(rclcpp_lifecycle::State()), NODE_SUCCESS);
ASSERT_TRUE(std::isnan(controller_->command_interfaces_[0].get_value()));
ASSERT_TRUE(std::isnan(controller_->command_interfaces_[0].get_optional().value()));

ASSERT_EQ(
controller_->update(rclcpp::Time(0, 0, RCL_ROS_TIME), rclcpp::Duration::from_seconds(0.01)),
Expand Down Expand Up @@ -176,17 +176,17 @@ TEST_F(AckermannSteeringControllerTest, test_update_logic)

// we test with open_loop=false, but steering angle was not updated (is zero) -> same commands
EXPECT_NEAR(
controller_->command_interfaces_[CMD_TRACTION_RIGHT_WHEEL].get_value(), 0.22222222222222224,
COMMON_THRESHOLD);
controller_->command_interfaces_[CMD_TRACTION_RIGHT_WHEEL].get_optional().value(),
0.22222222222222224, COMMON_THRESHOLD);
EXPECT_NEAR(
controller_->command_interfaces_[CMD_TRACTION_LEFT_WHEEL].get_value(), 0.22222222222222224,
COMMON_THRESHOLD);
controller_->command_interfaces_[CMD_TRACTION_LEFT_WHEEL].get_optional().value(),
0.22222222222222224, COMMON_THRESHOLD);
EXPECT_NEAR(
controller_->command_interfaces_[CMD_STEER_RIGHT_WHEEL].get_value(), 1.4179821977774734,
COMMON_THRESHOLD);
controller_->command_interfaces_[CMD_STEER_RIGHT_WHEEL].get_optional().value(),
1.4179821977774734, COMMON_THRESHOLD);
EXPECT_NEAR(
controller_->command_interfaces_[CMD_STEER_LEFT_WHEEL].get_value(), 1.4179821977774734,
COMMON_THRESHOLD);
controller_->command_interfaces_[CMD_STEER_LEFT_WHEEL].get_optional().value(),
1.4179821977774734, COMMON_THRESHOLD);

EXPECT_FALSE(std::isnan((*(controller_->input_ref_.readFromRT()))->twist.linear.x));
EXPECT_EQ(controller_->reference_interfaces_.size(), joint_reference_interfaces_.size());
Expand Down Expand Up @@ -216,17 +216,17 @@ TEST_F(AckermannSteeringControllerTest, test_update_logic_chained)

// we test with open_loop=false, but steering angle was not updated (is zero) -> same commands
EXPECT_NEAR(
controller_->command_interfaces_[STATE_TRACTION_RIGHT_WHEEL].get_value(), 0.22222222222222224,
COMMON_THRESHOLD);
controller_->command_interfaces_[STATE_TRACTION_RIGHT_WHEEL].get_optional().value(),
0.22222222222222224, COMMON_THRESHOLD);
EXPECT_NEAR(
controller_->command_interfaces_[STATE_TRACTION_LEFT_WHEEL].get_value(), 0.22222222222222224,
COMMON_THRESHOLD);
controller_->command_interfaces_[STATE_TRACTION_LEFT_WHEEL].get_optional().value(),
0.22222222222222224, COMMON_THRESHOLD);
EXPECT_NEAR(
controller_->command_interfaces_[STATE_STEER_RIGHT_WHEEL].get_value(), 1.4179821977774734,
COMMON_THRESHOLD);
controller_->command_interfaces_[STATE_STEER_RIGHT_WHEEL].get_optional().value(),
1.4179821977774734, COMMON_THRESHOLD);
EXPECT_NEAR(
controller_->command_interfaces_[STATE_STEER_LEFT_WHEEL].get_value(), 1.4179821977774734,
COMMON_THRESHOLD);
controller_->command_interfaces_[STATE_STEER_LEFT_WHEEL].get_optional().value(),
1.4179821977774734, COMMON_THRESHOLD);

EXPECT_TRUE(std::isnan((*(controller_->input_ref_.readFromRT()))->twist.linear.x));
EXPECT_EQ(controller_->reference_interfaces_.size(), joint_reference_interfaces_.size());
Expand Down Expand Up @@ -266,17 +266,17 @@ TEST_F(AckermannSteeringControllerTest, receive_message_and_publish_updated_stat

// we test with open_loop=false, but steering angle was not updated (is zero) -> same commands
EXPECT_NEAR(
controller_->command_interfaces_[CMD_TRACTION_RIGHT_WHEEL].get_value(), 0.22222222222222224,
COMMON_THRESHOLD);
controller_->command_interfaces_[CMD_TRACTION_RIGHT_WHEEL].get_optional().value(),
0.22222222222222224, COMMON_THRESHOLD);
EXPECT_NEAR(
controller_->command_interfaces_[CMD_TRACTION_LEFT_WHEEL].get_value(), 0.22222222222222224,
COMMON_THRESHOLD);
controller_->command_interfaces_[CMD_TRACTION_LEFT_WHEEL].get_optional().value(),
0.22222222222222224, COMMON_THRESHOLD);
EXPECT_NEAR(
controller_->command_interfaces_[CMD_STEER_RIGHT_WHEEL].get_value(), 1.4179821977774734,
COMMON_THRESHOLD);
controller_->command_interfaces_[CMD_STEER_RIGHT_WHEEL].get_optional().value(),
1.4179821977774734, COMMON_THRESHOLD);
EXPECT_NEAR(
controller_->command_interfaces_[CMD_STEER_LEFT_WHEEL].get_value(), 1.4179821977774734,
COMMON_THRESHOLD);
controller_->command_interfaces_[CMD_STEER_LEFT_WHEEL].get_optional().value(),
1.4179821977774734, COMMON_THRESHOLD);

subscribe_and_get_messages(msg);

Expand Down
17 changes: 15 additions & 2 deletions bicycle_steering_controller/src/bicycle_steering_controller.cpp
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -54,14 +54,27 @@ controller_interface::CallbackReturn BicycleSteeringController::configure_odomet

bool BicycleSteeringController::update_odometry(const rclcpp::Duration & period)
{
auto logger = get_node()->get_logger();

if (params_.open_loop)
{
odometry_.update_open_loop(last_linear_velocity_, last_angular_velocity_, period.seconds());
}
else
{
const double traction_wheel_value = state_interfaces_[STATE_TRACTION_WHEEL].get_value();
const double steering_position = state_interfaces_[STATE_STEER_AXIS].get_value();
const auto traction_wheel_value_op = state_interfaces_[STATE_TRACTION_WHEEL].get_optional();
const auto steering_position_op = state_interfaces_[STATE_STEER_AXIS].get_optional();

if (!traction_wheel_value_op.has_value() || !steering_position_op.has_value())
{
RCLCPP_DEBUG(
logger, "Unable to retrieve the data from the traction wheel or steering position!");
return true;
}

const double traction_wheel_value = traction_wheel_value_op.value();
const double steering_position = steering_position_op.value();

if (std::isfinite(traction_wheel_value) && std::isfinite(steering_position))
{
if (params_.position_feedback)
Expand Down
19 changes: 11 additions & 8 deletions bicycle_steering_controller/test/test_bicycle_steering_controller.cpp
View file
Open in desktop
Original file line number Diff line number Diff line change
Expand Up @@ -127,9 +127,9 @@ TEST_F(BicycleSteeringControllerTest, reactivate_success)
ASSERT_EQ(controller_->on_configure(rclcpp_lifecycle::State()), NODE_SUCCESS);
ASSERT_EQ(controller_->on_activate(rclcpp_lifecycle::State()), NODE_SUCCESS);
ASSERT_EQ(controller_->on_deactivate(rclcpp_lifecycle::State()), NODE_SUCCESS);
ASSERT_TRUE(std::isnan(controller_->command_interfaces_[0].get_value()));
ASSERT_TRUE(std::isnan(controller_->command_interfaces_[0].get_optional().value()));
ASSERT_EQ(controller_->on_activate(rclcpp_lifecycle::State()), NODE_SUCCESS);
ASSERT_TRUE(std::isnan(controller_->command_interfaces_[0].get_value()));
ASSERT_TRUE(std::isnan(controller_->command_interfaces_[0].get_optional().value()));

ASSERT_EQ(
controller_->update(rclcpp::Time(0, 0, RCL_ROS_TIME), rclcpp::Duration::from_seconds(0.01)),
Expand Down Expand Up @@ -159,9 +159,10 @@ TEST_F(BicycleSteeringControllerTest, test_update_logic)
controller_interface::return_type::OK);

EXPECT_NEAR(
controller_->command_interfaces_[CMD_TRACTION_WHEEL].get_value(), 0.1 / 0.45, COMMON_THRESHOLD);
controller_->command_interfaces_[CMD_TRACTION_WHEEL].get_optional().value(), 0.1 / 0.45,
COMMON_THRESHOLD);
EXPECT_NEAR(
controller_->command_interfaces_[CMD_STEER_WHEEL].get_value(), 1.4179821977774734,
controller_->command_interfaces_[CMD_STEER_WHEEL].get_optional().value(), 1.4179821977774734,
COMMON_THRESHOLD);

EXPECT_FALSE(std::isnan((*(controller_->input_ref_.readFromRT()))->twist.linear.x));
Expand Down Expand Up @@ -191,9 +192,10 @@ TEST_F(BicycleSteeringControllerTest, test_update_logic_chained)
controller_interface::return_type::OK);

EXPECT_NEAR(
controller_->command_interfaces_[CMD_TRACTION_WHEEL].get_value(), 0.1 / 0.45, COMMON_THRESHOLD);
controller_->command_interfaces_[CMD_TRACTION_WHEEL].get_optional().value(), 0.1 / 0.45,
COMMON_THRESHOLD);
EXPECT_NEAR(
controller_->command_interfaces_[CMD_STEER_WHEEL].get_value(), 1.4179821977774734,
controller_->command_interfaces_[CMD_STEER_WHEEL].get_optional().value(), 1.4179821977774734,
COMMON_THRESHOLD);

EXPECT_TRUE(std::isnan((*(controller_->input_ref_.readFromRT()))->twist.linear.x));
Expand Down Expand Up @@ -246,9 +248,10 @@ TEST_F(BicycleSteeringControllerTest, receive_message_and_publish_updated_status
controller_interface::return_type::OK);

EXPECT_NEAR(
controller_->command_interfaces_[CMD_TRACTION_WHEEL].get_value(), 0.1 / 0.45, COMMON_THRESHOLD);
controller_->command_interfaces_[CMD_TRACTION_WHEEL].get_optional().value(), 0.1 / 0.45,
COMMON_THRESHOLD);
EXPECT_NEAR(
controller_->command_interfaces_[CMD_STEER_WHEEL].get_value(), 1.4179821977774734,
controller_->command_interfaces_[CMD_STEER_WHEEL].get_optional().value(), 1.4179821977774734,
COMMON_THRESHOLD);

subscribe_and_get_messages(msg);
Expand Down
Loading