diff --git a/openarm_bimanual_moveit_config/launch/demo.launch.py b/openarm_bimanual_moveit_config/launch/demo.launch.py index 8afef71..9b348de 100644 --- a/openarm_bimanual_moveit_config/launch/demo.launch.py +++ b/openarm_bimanual_moveit_config/launch/demo.launch.py @@ -348,6 +348,6 @@ def generate_launch_description(): delayed_gripper, run_move_group_node, rviz_node, - delayed_servo, + # delayed_servo, ] ) diff --git a/openarm_bringup/launch/openarm.launch.py b/openarm_bringup/launch/openarm.launch.py index b1bee20..847bbd0 100644 --- a/openarm_bringup/launch/openarm.launch.py +++ b/openarm_bringup/launch/openarm.launch.py @@ -140,7 +140,7 @@ def generate_launch_description(): ), DeclareLaunchArgument( "can_interface", - default_value="can4", + default_value="can0", description="CAN interface to use.", ), DeclareLaunchArgument( diff --git a/openarm_hardware/src/v10_simple_hardware.cpp b/openarm_hardware/src/v10_simple_hardware.cpp index 1a42257..9f636cb 100644 --- a/openarm_hardware/src/v10_simple_hardware.cpp +++ b/openarm_hardware/src/v10_simple_hardware.cpp @@ -274,6 +274,10 @@ hardware_interface::return_type OpenArm_v10HW::write( for (size_t i = 0; i < ARM_DOF; ++i) { arm_params.push_back( {kp_[i], kd_[i], pos_commands_[i], vel_commands_[i], tau_commands_[i]}); + // if(vel_commands_[i] != 0) + // std::cout << "Arm Joint " << i + 1 << ": pos_cmd=" << pos_commands_[i] + // << ", vel_cmd=" << vel_commands_[i] + // << ", tau_cmd=" << tau_commands_[i] << std::endl; } openarm_->get_arm().mit_control_all(arm_params); // Control gripper if enabled