From e3f0679628c8472c07429527db804bc83ea7868f Mon Sep 17 00:00:00 2001 From: Yannis Chatzikonstantinou Date: Wed, 20 Sep 2023 23:29:01 +0300 Subject: [PATCH] compare with actual mode --- src/tm_joint_iface.cpp | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/src/tm_joint_iface.cpp b/src/tm_joint_iface.cpp index 6fb5db4..4902874 100644 --- a/src/tm_joint_iface.cpp +++ b/src/tm_joint_iface.cpp @@ -252,7 +252,7 @@ bool TinymovrJoint::init(ros::NodeHandle& root_nh, ros::NodeHandle& robot_hw_nh) servos[i].controller.set_mode(mode); ros::Duration(0.001).sleep(); ROS_INFO("Asserting state and mode"); - ROS_ASSERT((servos[i].controller.get_state() == 2) && (servos[i].controller.get_mode() == 1)); + ROS_ASSERT((servos[i].controller.get_state() == 2) && (servos[i].controller.get_mode() == mode)); } ROS_INFO("Registering Interfaces");