Skip to content
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.

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

Controller registration fail: This controller requires a hardware interface of type 'panda_hardware_interface::SharedJointInterface'. Make sure this is registered in the hardware_interface::RobotHW class #64

Open
tahir50169 opened this issue Jan 4, 2022 · 2 comments

Comments

@tahir50169
Copy link

I have integrated a Franka Emika Panda on a Clearpath Ridgeback. The simulation for Panda in this package works fine for me when run alone but does not work when integrated with the ridgeback robot.

I updated your franka_panda_description here to a macro and included it in my original URDF for the Ridgeback and other accessories file. Here is the code for that:

      <!-- Arm(for simulated robot) -->
      <xacro:if value="$(optenv RIDGEBACK_SIM)">
        <xacro:if value="$(optenv RIDGEBACK_PANDA 0)"> 
          <xacro:include filename="$(find mbs_rp_description)/xacro/accessories/panda_arm/panda_arm_sim.urdf.xacro"/> 
          <xacro:panda_arm robot_name="panda" load_gripper="false" load_gazebo="true" use_gazebo_control="false" connected_to="$(arg connected_to)"/>
        </xacro:if>
      </xacro:if>

This URDF works fine and I confirmed it with testing different parameters and it works fine.

After this I have included this by removing Gazebo launch include, robot_desription and URDF spawner for Gazebo and left all the default controllers as it is.

Now I have errors and the panda controllers are not launched probperly. Please have a look at the log below:

... logging to /home/mbs/.ros/log/ad088a06-6d59-11ec-9d30-3d63d0be0631/roslaunch-Development-67726.log
Checking log directory for disk usage. This may take a while.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.

started roslaunch server http://Development:41123/

SUMMARY
========

PARAMETERS
 * /SIMULATOR_: True
 * /arm/gravity_tip_name: panda_link8
 * /arm/root_name: panda_link0
 * /arm/tip_name: panda_link8
 * /controllers_config/default_controller: panda_simulator/p...
 * /controllers_config/position_controller: panda_simulator/p...
 * /controllers_config/torque_controller: panda_simulator/e...
 * /controllers_config/velocity_controller: panda_simulator/v...
 * /ekf_localization/base_link_frame: base_link
 * /ekf_localization/frequency: 50
 * /ekf_localization/imu0: /imu/data
 * /ekf_localization/imu0_config: [False, False, Fa...
 * /ekf_localization/imu0_differential: False
 * /ekf_localization/odom0: /ridgeback_veloci...
 * /ekf_localization/odom0_config: [False, False, Fa...
 * /ekf_localization/odom0_differential: False
 * /ekf_localization/odom_frame: odom
 * /ekf_localization/two_d_mode: True
 * /ekf_localization/world_frame: odom
 * /gazebo/enable_ros_network: True
 * /gazebo_ros_control/pid_gains/front_left_wheel/d: 0
 * /gazebo_ros_control/pid_gains/front_left_wheel/i: 0.1
 * /gazebo_ros_control/pid_gains/front_left_wheel/p: 1
 * /gazebo_ros_control/pid_gains/front_right_wheel/d: 0
 * /gazebo_ros_control/pid_gains/front_right_wheel/i: 0.1
 * /gazebo_ros_control/pid_gains/front_right_wheel/p: 1
 * /gazebo_ros_control/pid_gains/rear_left_wheel/d: 0
 * /gazebo_ros_control/pid_gains/rear_left_wheel/i: 0.1
 * /gazebo_ros_control/pid_gains/rear_left_wheel/p: 1
 * /gazebo_ros_control/pid_gains/rear_right_wheel/d: 0
 * /gazebo_ros_control/pid_gains/rear_right_wheel/i: 0.1
 * /gazebo_ros_control/pid_gains/rear_right_wheel/p: 1
 * /gripper_config/default_grasp_epsilon/inner: 0.005
 * /gripper_config/default_grasp_epsilon/outer: 0.005
 * /gripper_config/default_speed: 0.1
 * /gripper_config/joint_names: ['panda_finger_jo...
 * /lift_joint_position_controller/gains/d: 0
 * /lift_joint_position_controller/gains/i: 0.1
 * /lift_joint_position_controller/gains/p: 1
 * /lift_joint_position_controller/joint: mbs_lift_joint
 * /lift_joint_position_controller/type: position_controll...
 * /lift_joint_state_controller/publish_rate: 50
 * /lift_joint_state_controller/type: joint_state_contr...
 * /panda_simulator/effort_joint_gravity_controller/joints/panda_joint1_controller/joint: panda_joint1
 * /panda_simulator/effort_joint_gravity_controller/joints/panda_joint2_controller/joint: panda_joint2
 * /panda_simulator/effort_joint_gravity_controller/joints/panda_joint3_controller/joint: panda_joint3
 * /panda_simulator/effort_joint_gravity_controller/joints/panda_joint4_controller/joint: panda_joint4
 * /panda_simulator/effort_joint_gravity_controller/joints/panda_joint5_controller/joint: panda_joint5
 * /panda_simulator/effort_joint_gravity_controller/joints/panda_joint6_controller/joint: panda_joint6
 * /panda_simulator/effort_joint_gravity_controller/joints/panda_joint7_controller/joint: panda_joint7
 * /panda_simulator/effort_joint_gravity_controller/type: panda_sim_control...
 * /panda_simulator/effort_joint_torque_controller/joints/panda_joint1_controller/joint: panda_joint1
 * /panda_simulator/effort_joint_torque_controller/joints/panda_joint2_controller/joint: panda_joint2
 * /panda_simulator/effort_joint_torque_controller/joints/panda_joint3_controller/joint: panda_joint3
 * /panda_simulator/effort_joint_torque_controller/joints/panda_joint4_controller/joint: panda_joint4
 * /panda_simulator/effort_joint_torque_controller/joints/panda_joint5_controller/joint: panda_joint5
 * /panda_simulator/effort_joint_torque_controller/joints/panda_joint6_controller/joint: panda_joint6
 * /panda_simulator/effort_joint_torque_controller/joints/panda_joint7_controller/joint: panda_joint7
 * /panda_simulator/effort_joint_torque_controller/topic: /panda_simulator/...
 * /panda_simulator/effort_joint_torque_controller/type: panda_sim_control...
 * /panda_simulator/joint_state_controller/publish_rate: 100
 * /panda_simulator/joint_state_controller/type: joint_state_contr...
 * /panda_simulator/position_joint_position_controller/joints/panda_joint1_controller/joint: panda_joint1
 * /panda_simulator/position_joint_position_controller/joints/panda_joint1_controller/pid/d: 25.0
 * /panda_simulator/position_joint_position_controller/joints/panda_joint1_controller/pid/i: 10.0
 * /panda_simulator/position_joint_position_controller/joints/panda_joint1_controller/pid/p: 3000
 * /panda_simulator/position_joint_position_controller/joints/panda_joint2_controller/joint: panda_joint2
 * /panda_simulator/position_joint_position_controller/joints/panda_joint2_controller/pid/d: 30.0
 * /panda_simulator/position_joint_position_controller/joints/panda_joint2_controller/pid/i: 10.0
 * /panda_simulator/position_joint_position_controller/joints/panda_joint2_controller/pid/p: 3000
 * /panda_simulator/position_joint_position_controller/joints/panda_joint3_controller/joint: panda_joint3
 * /panda_simulator/position_joint_position_controller/joints/panda_joint3_controller/pid/d: 30.0
 * /panda_simulator/position_joint_position_controller/joints/panda_joint3_controller/pid/i: 10.0
 * /panda_simulator/position_joint_position_controller/joints/panda_joint3_controller/pid/p: 3000
 * /panda_simulator/position_joint_position_controller/joints/panda_joint4_controller/joint: panda_joint4
 * /panda_simulator/position_joint_position_controller/joints/panda_joint4_controller/pid/d: 50.0
 * /panda_simulator/position_joint_position_controller/joints/panda_joint4_controller/pid/i: 10.0
 * /panda_simulator/position_joint_position_controller/joints/panda_joint4_controller/pid/p: 3000
 * /panda_simulator/position_joint_position_controller/joints/panda_joint5_controller/joint: panda_joint5
 * /panda_simulator/position_joint_position_controller/joints/panda_joint5_controller/pid/d: 8.0
 * /panda_simulator/position_joint_position_controller/joints/panda_joint5_controller/pid/i: 10.0
 * /panda_simulator/position_joint_position_controller/joints/panda_joint5_controller/pid/p: 3000
 * /panda_simulator/position_joint_position_controller/joints/panda_joint6_controller/joint: panda_joint6
 * /panda_simulator/position_joint_position_controller/joints/panda_joint6_controller/pid/d: 5.0
 * /panda_simulator/position_joint_position_controller/joints/panda_joint6_controller/pid/i: 1.0
 * /panda_simulator/position_joint_position_controller/joints/panda_joint6_controller/pid/p: 3000
 * /panda_simulator/position_joint_position_controller/joints/panda_joint7_controller/joint: panda_joint7
 * /panda_simulator/position_joint_position_controller/joints/panda_joint7_controller/pid/d: 4.0
 * /panda_simulator/position_joint_position_controller/joints/panda_joint7_controller/pid/i: 10.0
 * /panda_simulator/position_joint_position_controller/joints/panda_joint7_controller/pid/p: 3000
 * /panda_simulator/position_joint_position_controller/topic_joint_command: /panda_simulator/...
 * /panda_simulator/position_joint_position_controller/topic_set_speed_ratio: /panda_simulator/...
 * /panda_simulator/position_joint_position_controller/type: panda_sim_control...
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint1_controller/joint: panda_joint1
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint1_controller/pid/d: 0.1
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint1_controller/pid/i: 0.0
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint1_controller/pid/p: 10
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint2_controller/joint: panda_joint2
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint2_controller/pid/d: 0.1
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint2_controller/pid/i: 1.0
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint2_controller/pid/p: 100
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint3_controller/joint: panda_joint3
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint3_controller/pid/d: 0.01
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint3_controller/pid/i: 0.0
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint3_controller/pid/p: 0.05
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint4_controller/joint: panda_joint4
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint4_controller/pid/d: 0.1
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint4_controller/pid/i: 0.01
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint4_controller/pid/p: 0.5
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint5_controller/joint: panda_joint5
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint5_controller/pid/d: 0.01
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint5_controller/pid/i: 0.0
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint5_controller/pid/p: 1.0
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint6_controller/joint: panda_joint6
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint6_controller/pid/d: 0.01
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint6_controller/pid/i: 0.0
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint6_controller/pid/p: 0.05
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint7_controller/joint: panda_joint7
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint7_controller/pid/d: 0.01
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint7_controller/pid/i: 0.0
 * /panda_simulator/velocity_joint_velocity_controller/joints/panda_joint7_controller/pid/p: 0.05
 * /panda_simulator/velocity_joint_velocity_controller/topic: /panda_simulator/...
 * /panda_simulator/velocity_joint_velocity_controller/type: panda_sim_control...
 * /ridgeback_joint_publisher/publish_rate: 50
 * /ridgeback_joint_publisher/type: joint_state_contr...
 * /ridgeback_velocity_controller/angular/z/has_acceleration_limits: True
 * /ridgeback_velocity_controller/angular/z/has_velocity_limits: True
 * /ridgeback_velocity_controller/angular/z/max_acceleration: 1.0
 * /ridgeback_velocity_controller/angular/z/max_velocity: 2.0
 * /ridgeback_velocity_controller/back_left_wheel_joint: rear_left_wheel
 * /ridgeback_velocity_controller/back_right_wheel_joint: rear_right_wheel
 * /ridgeback_velocity_controller/cmd_vel_timeout: 0.25
 * /ridgeback_velocity_controller/enable_odom_tf: False
 * /ridgeback_velocity_controller/front_left_wheel_joint: front_left_wheel
 * /ridgeback_velocity_controller/front_right_wheel_joint: front_right_wheel
 * /ridgeback_velocity_controller/linear/x/has_acceleration_limits: True
 * /ridgeback_velocity_controller/linear/x/has_velocity_limits: True
 * /ridgeback_velocity_controller/linear/x/max_acceleration: 2.5
 * /ridgeback_velocity_controller/linear/x/max_velocity: 1.1
 * /ridgeback_velocity_controller/linear/y/has_acceleration_limits: True
 * /ridgeback_velocity_controller/linear/y/has_velocity_limits: True
 * /ridgeback_velocity_controller/linear/y/max_acceleration: 2.5
 * /ridgeback_velocity_controller/linear/y/max_velocity: 1.1
 * /ridgeback_velocity_controller/pose_covariance_diagonal: [0.001, 0.001, 10...
 * /ridgeback_velocity_controller/publish_rate: 50
 * /ridgeback_velocity_controller/twist_covariance_diagonal: [0.001, 0.001, 0....
 * /ridgeback_velocity_controller/type: mecanum_drive_con...
 * /ridgeback_velocity_controller/wheel_radius_multiplier: 1.0
 * /ridgeback_velocity_controller/wheel_separation_multiplier: 1.0
 * /ridgeback_velocity_controller/wheel_separation_x: 0.638
 * /ridgeback_velocity_controller/wheel_separation_y: 0.551
 * /robot_config/arm_id: panda
 * /robot_config/joint_config/joint_acceleration_limit/panda_joint1: 15.0
 * /robot_config/joint_config/joint_acceleration_limit/panda_joint2: 7.5
 * /robot_config/joint_config/joint_acceleration_limit/panda_joint3: 10.0
 * /robot_config/joint_config/joint_acceleration_limit/panda_joint4: 12.5
 * /robot_config/joint_config/joint_acceleration_limit/panda_joint5: 15.0
 * /robot_config/joint_config/joint_acceleration_limit/panda_joint6: 20.0
 * /robot_config/joint_config/joint_acceleration_limit/panda_joint7: 20.0
 * /robot_config/joint_config/joint_effort_limit/panda_joint1: 87
 * /robot_config/joint_config/joint_effort_limit/panda_joint2: 87
 * /robot_config/joint_config/joint_effort_limit/panda_joint3: 87
 * /robot_config/joint_config/joint_effort_limit/panda_joint4: 87
 * /robot_config/joint_config/joint_effort_limit/panda_joint5: 12
 * /robot_config/joint_config/joint_effort_limit/panda_joint6: 12
 * /robot_config/joint_config/joint_effort_limit/panda_joint7: 12
 * /robot_config/joint_config/joint_position_limit/lower/panda_joint1: -2.8973
 * /robot_config/joint_config/joint_position_limit/lower/panda_joint2: -1.7628
 * /robot_config/joint_config/joint_position_limit/lower/panda_joint3: -2.8973
 * /robot_config/joint_config/joint_position_limit/lower/panda_joint4: -3.0718
 * /robot_config/joint_config/joint_position_limit/lower/panda_joint5: -2.8973
 * /robot_config/joint_config/joint_position_limit/lower/panda_joint6: -0.0175
 * /robot_config/joint_config/joint_position_limit/lower/panda_joint7: -2.8973
 * /robot_config/joint_config/joint_position_limit/upper/panda_joint1: 2.8973
 * /robot_config/joint_config/joint_position_limit/upper/panda_joint2: 1.7628
 * /robot_config/joint_config/joint_position_limit/upper/panda_joint3: 2.8973
 * /robot_config/joint_config/joint_position_limit/upper/panda_joint4: -0.0698
 * /robot_config/joint_config/joint_position_limit/upper/panda_joint5: 2.8973
 * /robot_config/joint_config/joint_position_limit/upper/panda_joint6: 3.7525
 * /robot_config/joint_config/joint_position_limit/upper/panda_joint7: 2.8973
 * /robot_config/joint_config/joint_velocity_limit/panda_joint1: 2.175
 * /robot_config/joint_config/joint_velocity_limit/panda_joint2: 2.175
 * /robot_config/joint_config/joint_velocity_limit/panda_joint3: 2.175
 * /robot_config/joint_config/joint_velocity_limit/panda_joint4: 2.175
 * /robot_config/joint_config/joint_velocity_limit/panda_joint5: 2.61
 * /robot_config/joint_config/joint_velocity_limit/panda_joint6: 2.61
 * /robot_config/joint_config/joint_velocity_limit/panda_joint7: 2.61
 * /robot_config/joint_names: ['panda_joint1', ...
 * /robot_config/neutral_pose/panda_joint1: -0.01779206022777...
 * /robot_config/neutral_pose/panda_joint2: -0.7601235411041661
 * /robot_config/neutral_pose/panda_joint3: 0.019782607023391807
 * /robot_config/neutral_pose/panda_joint4: -2.342050140544315
 * /robot_config/neutral_pose/panda_joint5: 0.029840531355804868
 * /robot_config/neutral_pose/panda_joint6: 1.5411935298621688
 * /robot_config/neutral_pose/panda_joint7: 0.7534486589746342
 * /robot_description: <?xml version="1....
 * /rosdistro: noetic
 * /rosversion: 1.15.13
 * /twist_marker_server/linear_scale/x: 1
 * /twist_marker_server/linear_scale/y: 1
 * /twist_marker_server/max_negative_linear_velocity/x: -1
 * /twist_marker_server/max_negative_linear_velocity/y: -1
 * /twist_marker_server/max_positive_linear_velocity/x: 1
 * /twist_marker_server/max_positive_linear_velocity/y: 1
 * /use_sim_time: True

NODES
  /
    cmd_vel_relay (topic_tools/relay)
    controller_spawner_on (controller_manager/controller_manager)
    controller_spawner_stopped (controller_manager/controller_manager)
    ekf_localization (robot_localization/ekf_localization_node)
    gazebo (gazebo_ros/gzserver)
    gazebo_gui (gazebo_ros/gzclient)
    joint_trajectory_server_emulator (panda_sim_custom_action_server/start_joint_trajectory_server.py)
    mbs_rp_controller_spawner (controller_manager/spawner)
    robot_state_publisher (robot_state_publisher/robot_state_publisher)
    startup_script (panda_gazebo/force_neutral_pose.py)
    topic_remap (topic_tools/relay)
    twist_marker_server (interactive_marker_twist_server/marker_server)
    urdf_spawner (gazebo_ros/spawn_model)

auto-starting new master
process[master]: started with pid [67740]
ROS_MASTER_URI=http://localhost:11311

setting /run_id to ad088a06-6d59-11ec-9d30-3d63d0be0631
process[rosout-1]: started with pid [67790]
started core service [/rosout]
process[robot_state_publisher-2]: started with pid [67798]
process[gazebo-3]: started with pid [67799]
process[gazebo_gui-4]: started with pid [67804]
process[urdf_spawner-5]: started with pid [67815]
process[ekf_localization-6]: started with pid [67818]
process[cmd_vel_relay-7]: started with pid [67822]
process[twist_marker_server-8]: started with pid [67827]
process[mbs_rp_controller_spawner-9]: started with pid [67832]
process[controller_spawner_on-10]: started with pid [67837]
process[controller_spawner_stopped-11]: started with pid [67841]
process[topic_remap-12]: started with pid [67842]
process[joint_trajectory_server_emulator-13]: started with pid [67845]
process[startup_script-14]: started with pid [67848]
[INFO] [1641299249.645095, 0.000000]: Controller Spawner: Waiting for service controller_manager/load_controller
[ INFO] [1641299249.925514704]: Finished loading Gazebo ROS API Plugin.
[ INFO] [1641299249.929125832]: waitForService: Service [/gazebo/set_physics_properties] has not been advertised, waiting...
[ INFO] [1641299250.185857356]: Finished loading Gazebo ROS API Plugin.
[ INFO] [1641299250.187111066]: waitForService: Service [/gazebo_gui/set_physics_properties] has not been advertised, waiting...
[ INFO] [1641299250.810984731]: waitForService: Service [/gazebo/set_physics_properties] is now available.
[ERROR] [1641299250.985350, 2761.727000]: Spawn service failed. Exiting.
[ INFO] [1641299250.994471444, 2761.727000000]: Physics dynamic reconfigure ready.
Warning [Model.cc:212] Non-unique names detected in XML children of model with name[ridgeback].
[ INFO] [1641299251.565410133, 2761.727000000]: Laser Plugin: Using the 'robotNamespace' param: '/'
[ INFO] [1641299251.565507167, 2761.727000000]: Starting Laser Plugin (ns = /)
[ INFO] [1641299251.566932102, 2761.727000000]: Laser Plugin (ns = /)  <tf_prefix_>, set to ""
[urdf_spawner-5] process has died [pid 67815, exit code 1, cmd /opt/ros/noetic/lib/gazebo_ros/spawn_model -urdf -model ridgeback -param robot_description -x 0 -y 0 -z 0.1 -Y 0 __name:=urdf_spawner __log:=/home/mbs/.ros/log/ad088a06-6d59-11ec-9d30-3d63d0be0631/urdf_spawner-5.log].
log file: /home/mbs/.ros/log/ad088a06-6d59-11ec-9d30-3d63d0be0631/urdf_spawner-5*.log
[ INFO] [1641299251.817883880, 2761.727000000]: Laser Plugin: Using the 'robotNamespace' param: '/'
[ INFO] [1641299251.817951213, 2761.727000000]: Starting Laser Plugin (ns = /)
[ INFO] [1641299251.819309282, 2761.727000000]: Laser Plugin (ns = /)  <tf_prefix_>, set to ""
[ INFO] [1641299262.906477929, 2761.727000000]: Ouster laser plugin ready, 64 lasers
[ INFO] [1641299263.044380555, 2761.727000000]: Loading gazebo_ros_control plugin
[ INFO] [1641299263.044501736, 2761.727000000]: Starting gazebo_ros_control plugin in namespace: /
[ INFO] [1641299263.045210666, 2761.727000000]: gazebo_ros_control plugin is waiting for model URDF in parameter [robot_description] on the ROS param server.
[ERROR] [1641299263.234443768, 2761.727000000]: No p gain specified for pid.  Namespace: /gazebo_ros_control/pid_gains/mbs_lift_joint
[ERROR] [1641299263.235332415, 2761.727000000]: No p gain specified for pid.  Namespace: /gazebo_ros_control/pid_gains/linear_holder_2_joint
[ INFO] [1641299263.245676874, 2761.727000000]: Loaded gazebo_ros_control.
[ INFO] [1641299263.256263761, 2761.727000000]: ForceBasedMove using gains: yaw: 500 x: 10000 y: 10000

[ INFO] [1641299263.256328763, 2761.727000000]: robotBaseFrame for force based move plugin: base_link

[ INFO] [1641299263.314986041, 2761.727000000]: GazeboRosJointStatePublisher is going to publish joint: front_rocker
[ INFO] [1641299263.315040849, 2761.727000000]: Starting GazeboRosJointStatePublisher Plugin (ns = //)!, parent name: ridgeback
[ INFO] [1641299263.360212453, 2761.727000000]: ft_sensor plugin reporting wrench values to the frame [panda_link7]
[ INFO] [1641299263.360264654, 2761.727000000]: imu plugin missing <gaussianNoise>, defaults to 0.0
[ INFO] [1641299263.361487442, 2761.727000000]: Loading gazebo_ros_control plugin
[ INFO] [1641299263.361528743, 2761.727000000]: Starting gazebo_ros_control plugin in namespace: /
[ERROR] [1641299263.456742203, 2761.727000000]: This controller requires a hardware interface of type 'panda_hardware_interface::SharedJointInterface'. Make sure this is registered in the hardware_interface::RobotHW class.
[ERROR] [1641299263.456812231, 2761.727000000]: Initializing controller 'panda_simulator/velocity_joint_velocity_controller' failed
Error when loading 'panda_simulator/velocity_joint_velocity_controller'
[ERROR] [1641299263.463295908, 2761.727000000]: This controller requires a hardware interface of type 'panda_hardware_interface::SharedJointInterface'. Make sure this is registered in the hardware_interface::RobotHW class.
[ERROR] [1641299263.463361024, 2761.727000000]: Initializing controller 'panda_simulator/effort_joint_gravity_controller' failed
Error when loading 'panda_simulator/effort_joint_gravity_controller'
[ERROR] [1641299263.464990698, 2761.727000000]: This controller requires a hardware interface of type 'panda_hardware_interface::SharedJointInterface'. Make sure this is registered in the hardware_interface::RobotHW class.
[ERROR] [1641299263.465062841, 2761.727000000]: Initializing controller 'panda_simulator/position_joint_position_controller' failed
Error when loading 'panda_simulator/position_joint_position_controller'
[ERROR] [1641299263.473306586, 2761.727000000]: This controller requires a hardware interface of type 'panda_hardware_interface::SharedJointInterface'. Make sure this is registered in the hardware_interface::RobotHW class.
[ERROR] [1641299263.473404307, 2761.727000000]: Initializing controller 'panda_simulator/effort_joint_torque_controller' failed
Error when loading 'panda_simulator/effort_joint_torque_controller'
Loaded 'panda_simulator/joint_state_controller'
[ERROR] [1641299263.479318364, 2761.727000000]: Tried to advertise a service that is already advertised in this node [/gazebo_ros_control/pid_gains/front_left_wheel/set_parameters]
[ERROR] [1641299263.485746011, 2761.727000000]: Could not start controller with name 'panda_simulator/position_joint_position_controller' because no controller with this name exists
Error when starting ['panda_simulator/position_joint_position_controller'] and stopping []
[ERROR] [1641299263.504702191, 2761.727000000]: Tried to advertise a service that is already advertised in this node [/gazebo_ros_control/pid_gains/front_right_wheel/set_parameters]
[INFO] [1641299263.513402, 2761.727000]: Controller Spawner: Waiting for service controller_manager/switch_controller
[INFO] [1641299263.518311, 2761.727000]: Controller Spawner: Waiting for service controller_manager/unload_controller
[INFO] [1641299263.526630, 2761.727000]: Loading controller: ridgeback_joint_publisher
[ERROR] [1641299263.536651750, 2761.727000000]: Tried to advertise a service that is already advertised in this node [/gazebo_ros_control/pid_gains/rear_left_wheel/set_parameters]
[ERROR] [1641299263.566932359, 2761.727000000]: Tried to advertise a service that is already advertised in this node [/gazebo_ros_control/pid_gains/rear_right_wheel/set_parameters]
[ERROR] [1641299263.583248855, 2761.727000000]: No p gain specified for pid.  Namespace: /gazebo_ros_control/pid_gains/mbs_lift_joint
[ERROR] [1641299263.583873172, 2761.727000000]: No p gain specified for pid.  Namespace: /gazebo_ros_control/pid_gains/linear_holder_2_joint
[ERROR] [1641299263.587554460, 2761.727000000]: Tried to advertise a service that is already advertised in this node [/controller_manager/list_controllers]
[ERROR] [1641299263.587604864, 2761.727000000]: Tried to advertise a service that is already advertised in this node [/controller_manager/list_controller_types]
[ERROR] [1641299263.587642437, 2761.727000000]: Tried to advertise a service that is already advertised in this node [/controller_manager/load_controller]
[ERROR] [1641299263.587664830, 2761.727000000]: Tried to advertise a service that is already advertised in this node [/controller_manager/unload_controller]
[ERROR] [1641299263.587684241, 2761.727000000]: Tried to advertise a service that is already advertised in this node [/controller_manager/switch_controller]
[ERROR] [1641299263.587707700, 2761.727000000]: Tried to advertise a service that is already advertised in this node [/controller_manager/reload_controller_libraries]
[ INFO] [1641299263.587824891, 2761.727000000]: Loaded gazebo_ros_control.
[ WARN] [1641299263.590560869, 2761.728000000]: Failed to meet update rate! Took 2761.7280000000000655
Started ['panda_simulator/joint_state_controller'] successfully
[INFO] [1641299263.602101, 2761.734000]: Loading controller: ridgeback_velocity_controller
[ WARN] [1641299263.602784975, 2761.734000000]: Failed to meet update rate! Took 2761.7139999999999418
[ INFO] [1641299263.640094388, 2761.764000000]: Use the roller's radius rather than the wheel's: 0.
[ INFO] [1641299263.641205950, 2761.764000000]: Front left wheel joint (wheel0) is : front_left_wheel
[ INFO] [1641299263.644633614, 2761.767000000]: Back left wheel joint (wheel1) is : rear_left_wheel
[ INFO] [1641299263.646709175, 2761.767000000]: Back right wheel joint (wheel2) is : rear_right_wheel
[ INFO] [1641299263.647773663, 2761.768000000]: Front right wheel joint (wheel3) is : front_right_wheel
[ INFO] [1641299263.651165529, 2761.770000000]: Controller state will be published at 50Hz.
[ INFO] [1641299263.655435667, 2761.772000000]: Velocity commands will be considered old if they are older than 0.25s.
[ INFO] [1641299263.656221874, 2761.772000000]: Base frame_id set to base_link
[ INFO] [1641299263.656776631, 2761.772000000]: Odom frame_id set to odom
[ INFO] [1641299263.657741380, 2761.773000000]: Publishing to tf is disabled
[ INFO] [1641299263.684443623, 2761.795000000]: Wheel seperation in X: 0.638
[ INFO] [1641299263.684563652, 2761.795000000]: Wheel seperation in Y: 0.551
[ INFO] [1641299263.685940923, 2761.796000000]: Wheel radius: 0.0759
[INFO] [1641299263.705791, 2761.813000]: Loading controller: lift_joint_state_controller
[INFO] [1641299263.719097, 2761.815000]: Loading controller: lift_joint_position_controller
[INFO] [1641299263.750322, 2761.843000]: Controller Spawner: Loaded controllers: ridgeback_joint_publisher, ridgeback_velocity_controller, lift_joint_state_controller, lift_joint_position_controller
[INFO] [1641299263.758152, 2761.849000]: Started controllers: ridgeback_joint_publisher, ridgeback_velocity_controller, lift_joint_state_controller, lift_joint_position_controller
Traceback (most recent call last):
  File "/home/mbs/mbs_dev/mbs_ws/workspaces/mbs_rp_ws/devel/lib/panda_sim_custom_action_server/start_joint_trajectory_server.py", line 15, in <module>
    exec(compile(fh.read(), python_script, 'exec'), context)
  File "/home/mbs/mbs_dev/mbs_ws/workspaces/mbs_rp_ws/src/thirdy_party/franka_simulator/panda_simulator/panda_sim_custom_action_server/scripts/start_joint_trajectory_server.py", line 83, in <module>
    main()
  File "/home/mbs/mbs_dev/mbs_ws/workspaces/mbs_rp_ws/src/thirdy_party/franka_simulator/panda_simulator/panda_sim_custom_action_server/scripts/start_joint_trajectory_server.py", line 79, in main
    start_server(args.rate)
  File "/home/mbs/mbs_dev/mbs_ws/workspaces/mbs_rp_ws/src/thirdy_party/franka_simulator/panda_simulator/panda_sim_custom_action_server/scripts/start_joint_trajectory_server.py", line 56, in start_server
    jtas.append(JointTrajectoryActionServer(dyn_cfg_srv, rate))
  File "/home/mbs/mbs_dev/mbs_ws/workspaces/mbs_rp_ws/src/thirdy_party/franka_simulator/panda_simulator/panda_sim_custom_action_server/src/panda_sim_custom_action_server/joint_trajectory_action_server.py", line 170, in __init__
    self._arm = franka_interface.ArmInterface(synchronous_pub=True)
  File "/home/mbs/mbs_dev/mbs_ws/workspaces/mbs_rp_ws/src/thirdy_party/franka_simulator/franka_ros_interface/franka_interface/src/franka_interface/arm.py", line 213, in __init__
    franka_dataflow.wait_for(lambda: len(list(self._joint_angle.keys())) > 0,
  File "/home/mbs/mbs_dev/mbs_ws/workspaces/mbs_rp_ws/src/thirdy_party/franka_simulator/franka_ros_interface/franka_interface/src/franka_dataflow/wait_for.py", line 56, in wait_for
    raise OSError(errno.ETIMEDOUT, timeout_msg)
TimeoutError: [Errno 110] Panda arm init failed to get current joint_states from /panda_simulator/custom_franka_state_controller/joint_states
[controller_spawner_stopped-11] process has finished cleanly
log file: /home/mbs/.ros/log/ad088a06-6d59-11ec-9d30-3d63d0be0631/controller_spawner_stopped-11*.log
[controller_spawner_on-10] process has finished cleanly
log file: /home/mbs/.ros/log/ad088a06-6d59-11ec-9d30-3d63d0be0631/controller_spawner_on-10*.log
[startup_script-14] process has finished cleanly
log file: /home/mbs/.ros/log/ad088a06-6d59-11ec-9d30-3d63d0be0631/startup_script-14*.log
^C[joint_trajectory_server_emulator-13] killing on exit
[topic_remap-12] killing on exit
[mbs_rp_controller_spawner-9] killing on exit
[twist_marker_server-8] killing on exit
[cmd_vel_relay-7] killing on exit
[ekf_localization-6] killing on exit
[gazebo_gui-4] killing on exit
[gazebo-3] killing on exit
[robot_state_publisher-2] killing on exit
[INFO] [1641299342.029502, 2828.945000]: Shutting down spawner. Stopping and unloading controllers...
[INFO] [1641299342.031701, 2828.945000]: Stopping all controllers...
[gazebo_gui-4] escalating to SIGTERM
[mbs_rp_controller_spawner-9] escalating to SIGTERM
[gazebo-3] escalating to SIGTERM
[WARN] [1641299357.227320, 2828.951000]: Controller Spawner error while taking down controllers: transport error completing service call: unable to receive data from sender, check sender's logs for details
[rosout-1] killing on exit
[master] killing on exit
shutting down processing monitor...
... shutting down processing monitor complete
done

I really am not able to understand where the problem is coming from, any leads on solving the problem will highly be appreciated. Thank you so much in advance.

@github-actions
Copy link

github-actions bot commented Jan 4, 2022

Hi @tahir50169, thank you for using this repository. Unfortunately, I am unable to maintain this package any more, sorry!
If you are interested in contributing to this repository or are willing to maintain it, please contact me at mail@saifsidhik.page.
-- Saif

@tahir50169 tahir50169 reopened this Jan 4, 2022
@RENFAN0706
Copy link

Hi,I have met the same problem.Have you solved it?

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

No branches or pull requests

2 participants