search

justagist / panda_simulator

A Gazebo simulator for the Franka Emika Panda robot with ROS interface, supporting sim-to-real code transfer (Python). Exposes customisable controllers and state feedback from robot in simulation.
Apache License 2.0
188 stars 58 forks source link

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 2 years ago

tahir50169 commented 2 years ago

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[bot] commented 2 years ago

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

RENFAN0706 commented 2 years ago

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