Didn't received robot state (joint angles) with recent timestamp within 1 seconds. Check clock synchronization if your are running ROS across multiple machines!
Hello everybody, i'm currently using the Franka Emika Panda Robot and trying to learn about ROS Moveit!
Everything was working perfectly (trajectory planing with the Moveit) and suddenly, by trying out some scripts from the tutorial the following error came to me:
'Didn't received robot state (joint angles) with recent timestamp within 1 seconds. Check clock synchronization if your are running ROS across multiple machines!'
When i run my launchfile, this is the outcome: (everything ok)
roslaunch franka_drawing franka_drawing.launch
... logging to /home/jt/.ros/log/eea78224-b294-11e8-b8bc-fcaa14212913/roslaunch-vwagwoohsplsw05-8086.log
Checking log directory for disk usage. This may take awhile.
Press Ctrl-C to interrupt
Done checking log file disk usage. Usage is <1GB.
WARN: unrecognized 'param' tag in <include> tag
started roslaunch server http://vwagwoohsplsw05:40909/
SUMMARY
========
PARAMETERS
* /effort_joint_trajectory_controller/constraints/goal_time: 0.5
* /effort_joint_trajectory_controller/constraints/panda_joint1/goal: 0.05
* /effort_joint_trajectory_controller/constraints/panda_joint2/goal: 0.05
* /effort_joint_trajectory_controller/constraints/panda_joint3/goal: 0.05
* /effort_joint_trajectory_controller/constraints/panda_joint4/goal: 0.05
* /effort_joint_trajectory_controller/constraints/panda_joint5/goal: 0.05
* /effort_joint_trajectory_controller/constraints/panda_joint6/goal: 0.05
* /effort_joint_trajectory_controller/constraints/panda_joint7/goal: 0.05
* /effort_joint_trajectory_controller/gains/panda_joint1/d: 10
* /effort_joint_trajectory_controller/gains/panda_joint1/i: 0
* /effort_joint_trajectory_controller/gains/panda_joint1/i_clamp: 1
* /effort_joint_trajectory_controller/gains/panda_joint1/p: 100
* /effort_joint_trajectory_controller/gains/panda_joint2/d: 10
* /effort_joint_trajectory_controller/gains/panda_joint2/i: 0
* /effort_joint_trajectory_controller/gains/panda_joint2/i_clamp: 1
* /effort_joint_trajectory_controller/gains/panda_joint2/p: 100
* /effort_joint_trajectory_controller/gains/panda_joint3/d: 10
* /effort_joint_trajectory_controller/gains/panda_joint3/i: 0
* /effort_joint_trajectory_controller/gains/panda_joint3/i_clamp: 1
* /effort_joint_trajectory_controller/gains/panda_joint3/p: 100
* /effort_joint_trajectory_controller/gains/panda_joint4/d: 10
* /effort_joint_trajectory_controller/gains/panda_joint4/i: 0
* /effort_joint_trajectory_controller/gains/panda_joint4/i_clamp: 1
* /effort_joint_trajectory_controller/gains/panda_joint4/p: 100
* /effort_joint_trajectory_controller/gains/panda_joint5/d: 10
* /effort_joint_trajectory_controller/gains/panda_joint5/i: 0
* /effort_joint_trajectory_controller/gains/panda_joint5/i_clamp: 1
* /effort_joint_trajectory_controller/gains/panda_joint5/p: 100
* /effort_joint_trajectory_controller/gains/panda_joint6/d: 10
* /effort_joint_trajectory_controller/gains/panda_joint6/i: 0
* /effort_joint_trajectory_controller/gains/panda_joint6/i_clamp: 1
* /effort_joint_trajectory_controller/gains/panda_joint6/p: 100
* /effort_joint_trajectory_controller/gains/panda_joint7/d: 10
* /effort_joint_trajectory_controller/gains/panda_joint7/i: 0
* /effort_joint_trajectory_controller/gains/panda_joint7/i_clamp: 1
* /effort_joint_trajectory_controller/gains/panda_joint7/p: 100
* /effort_joint_trajectory_controller/joints: ['panda_joint1', ...
* /effort_joint_trajectory_controller/type: effort_controller...
* /franka_control/arm_id: panda
* /franka_control/cutoff_frequency: 100
* /franka_control/internal_controller: cartesian_impedance
* /franka_control/joint_names: ['panda_joint1', ...
* /franka_control/rate_limiting: True
* /franka_control/robot_ip: 172.16.0.2
* /franka_gripper/default_grasp_epsilon/inner: 0.005
* /franka_gripper/default_grasp_epsilon/outer: 0.005
* /franka_gripper/default_speed: 0.1
* /franka_gripper/joint_names: ['panda_finger_jo...
* /franka_gripper/publish_rate: 30
* /franka_gripper/robot_ip: 172.16.0.2
* /franka_state_controller/arm_id: panda
* /franka_state_controller/joint_names: ['panda_joint1', ...
* /franka_state_controller/publish_rate: 30
* /franka_state_controller/type: franka_control/Fr...
* /joint_state_publisher/rate: 30
* /joint_state_publisher/source_list: ['franka_state_co...
* /move_group/allow_trajectory_execution: True
* /move_group/controller_list: [{'action_ns': 'f...
* /move_group/hand/planner_configs: ['SBLkConfigDefau...
* /move_group/jiggle_fraction: 0.05
* /move_group/max_range: 5.0
* /move_group/max_safe_path_cost: 1
* /move_group/moveit_controller_manager: moveit_simple_con...
* /move_group/moveit_manage_controllers: True
* /move_group/octomap_resolution: 0.025
* /move_group/panda_arm/planner_configs: ['SBLkConfigDefau...
* /move_group/panda_arm_hand/planner_configs: ['SBLkConfigDefau...
* /move_group/planner_configs/BFMTkConfigDefault/balanced: 0
* /move_group/planner_configs/BFMTkConfigDefault/cache_cc: 1
* /move_group/planner_configs/BFMTkConfigDefault/extended_fmt: 1
* /move_group/planner_configs/BFMTkConfigDefault/heuristics: 1
* /move_group/planner_configs/BFMTkConfigDefault/nearest_k: 1
* /move_group/planner_configs/BFMTkConfigDefault/num_samples: 1000
* /move_group/planner_configs/BFMTkConfigDefault/optimality: 1
* /move_group/planner_configs/BFMTkConfigDefault/radius_multiplier: 1.0
* /move_group/planner_configs/BFMTkConfigDefault/type: geometric::BFMT
* /move_group/planner_configs/BKPIECEkConfigDefault/border_fraction: 0.9
* /move_group/planner_configs/BKPIECEkConfigDefault/failed_expansion_score_factor: 0.5
* /move_group/planner_configs/BKPIECEkConfigDefault/min_valid_path_fraction: 0.5
* /move_group/planner_configs/BKPIECEkConfigDefault/range: 0.0
* /move_group/planner_configs/BKPIECEkConfigDefault/type: geometric::BKPIECE
* /move_group/planner_configs/BiESTkConfigDefault/range: 0.0
* /move_group/planner_configs/BiESTkConfigDefault/type: geometric::BiEST
* /move_group/planner_configs/BiTRRTkConfigDefault/cost_threshold: 1e300
* /move_group/planner_configs/BiTRRTkConfigDefault/frountier_node_ratio: 0.1
* /move_group/planner_configs/BiTRRTkConfigDefault/frountier_threshold: 0.0
* /move_group/planner_configs/BiTRRTkConfigDefault/init_temperature: 100
* /move_group/planner_configs/BiTRRTkConfigDefault/range: 0.0
* /move_group/planner_configs/BiTRRTkConfigDefault/temp_change_factor: 0.1
* /move_group/planner_configs/BiTRRTkConfigDefault/type: geometric::BiTRRT
* /move_group/planner_configs/ESTkConfigDefault/goal_bias: 0.05
* /move_group/planner_configs/ESTkConfigDefault/range: 0.0
* /move_group/planner_configs/ESTkConfigDefault/type: geometric::EST
* /move_group/planner_configs/FMTkConfigDefault/cache_cc: 1
* /move_group/planner_configs/FMTkConfigDefault/extended_fmt: 1
* /move_group/planner_configs/FMTkConfigDefault/heuristics: 0
* /move_group/planner_configs/FMTkConfigDefault/nearest_k: 1
* /move_group/planner_configs/FMTkConfigDefault/num_samples: 1000
* /move_group/planner_configs/FMTkConfigDefault/radius_multiplier: 1.1
* /move_group/planner_configs/FMTkConfigDefault/type: geometric::FMT
* /move_group/planner_configs/KPIECEkConfigDefault/border_fraction: 0.9
* /move_group/planner_configs/KPIECEkConfigDefault/failed_expansion_score_factor: 0.5
* /move_group/planner_configs/KPIECEkConfigDefault/goal_bias: 0.05
* /move_group/planner_configs/KPIECEkConfigDefault/min_valid_path_fraction: 0.5
* /move_group/planner_configs/KPIECEkConfigDefault/range: 0.0
* /move_group/planner_configs/KPIECEkConfigDefault/type: geometric::KPIECE
* /move_group/planner_configs/LBKPIECEkConfigDefault/border_fraction: 0.9
* /move_group/planner_configs/LBKPIECEkConfigDefault/min_valid_path_fraction: 0.5
* /move_group/planner_configs/LBKPIECEkConfigDefault/range: 0.0
* /move_group/planner_configs/LBKPIECEkConfigDefault/type: geometric::LBKPIECE
* /move_group/planner_configs/LBTRRTkConfigDefault/epsilon: 0.4
* /move_group/planner_configs/LBTRRTkConfigDefault/goal_bias: 0.05
* /move_group/planner_configs/LBTRRTkConfigDefault/range: 0.0
* /move_group/planner_configs/LBTRRTkConfigDefault/type: geometric::LBTRRT
* /move_group/planner_configs/LazyPRMkConfigDefault/range: 0.0
* /move_group/planner_configs/LazyPRMkConfigDefault/type: geometric::LazyPRM
* /move_group/planner_configs/LazyPRMstarkConfigDefault/type: geometric::LazyPR...
* /move_group/planner_configs/PDSTkConfigDefault/type: geometric::PDST
* /move_group/planner_configs/PRMkConfigDefault/max_nearest_neighbors: 10
* /move_group/planner_configs/PRMkConfigDefault/type: geometric::PRM
* /move_group/planner_configs/PRMstarkConfigDefault/type: geometric::PRMstar
* /move_group/planner_configs/ProjESTkConfigDefault/goal_bias: 0.05
* /move_group/planner_configs/ProjESTkConfigDefault/range: 0.0
* /move_group/planner_configs/ProjESTkConfigDefault/type: geometric::ProjEST
* /move_group/planner_configs/RRTConnectkConfigDefault/range: 0.0
* /move_group/planner_configs/RRTConnectkConfigDefault/type: geometric::RRTCon...
* /move_group/planner_configs/RRTkConfigDefault/goal_bias: 0.05
* /move_group/planner_configs/RRTkConfigDefault/range: 0.0
* /move_group/planner_configs/RRTkConfigDefault/type: geometric::RRT
* /move_group/planner_configs/RRTstarkConfigDefault/delay_collision_checking: 1
* /move_group/planner_configs/RRTstarkConfigDefault/goal_bias: 0.05
* /move_group/planner_configs/RRTstarkConfigDefault/range: 0.0
* /move_group/planner_configs/RRTstarkConfigDefault/type: geometric::RRTstar
* /move_group/planner_configs/SBLkConfigDefault/range: 0.0
* /move_group/planner_configs/SBLkConfigDefault/type: geometric::SBL
* /move_group/planner_configs/SPARSkConfigDefault/dense_delta_fraction: 0.001
* /move_group/planner_configs/SPARSkConfigDefault/max_failures: 1000
* /move_group/planner_configs/SPARSkConfigDefault/sparse_delta_fraction: 0.25
* /move_group/planner_configs/SPARSkConfigDefault/stretch_factor: 3.0
* /move_group/planner_configs/SPARSkConfigDefault/type: geometric::SPARS
* /move_group/planner_configs/SPARStwokConfigDefault/dense_delta_fraction: 0.001
* /move_group/planner_configs/SPARStwokConfigDefault/max_failures: 5000
* /move_group/planner_configs/SPARStwokConfigDefault/sparse_delta_fraction: 0.25
* /move_group/planner_configs/SPARStwokConfigDefault/stretch_factor: 3.0
* /move_group/planner_configs/SPARStwokConfigDefault/type: geometric::SPARStwo
* /move_group/planner_configs/STRIDEkConfigDefault/degree: 16
* /move_group/planner_configs/STRIDEkConfigDefault/estimated_dimension: 0.0
* /move_group/planner_configs/STRIDEkConfigDefault/goal_bias: 0.05
* /move_group/planner_configs/STRIDEkConfigDefault/max_degree: 18
* /move_group/planner_configs/STRIDEkConfigDefault/max_pts_per_leaf: 6
* /move_group/planner_configs/STRIDEkConfigDefault/min_degree: 12
* /move_group/planner_configs/STRIDEkConfigDefault/min_valid_path_fraction: 0.2
* /move_group/planner_configs/STRIDEkConfigDefault/range: 0.0
* /move_group/planner_configs/STRIDEkConfigDefault/type: geometric::STRIDE
* /move_group/planner_configs/STRIDEkConfigDefault/use_projected_distance: 0
* /move_group/planner_configs/TRRTkConfigDefault/frountierNodeRatio: 0.1
* /move_group/planner_configs/TRRTkConfigDefault/frountier_threshold: 0.0
* /move_group/planner_configs/TRRTkConfigDefault/goal_bias: 0.05
* /move_group/planner_configs/TRRTkConfigDefault/init_temperature: 10e-6
* /move_group/planner_configs/TRRTkConfigDefault/k_constant: 0.0
* /move_group/planner_configs/TRRTkConfigDefault/max_states_failed: 10
* /move_group/planner_configs/TRRTkConfigDefault/min_temperature: 10e-10
* /move_group/planner_configs/TRRTkConfigDefault/range: 0.0
* /move_group/planner_configs/TRRTkConfigDefault/temp_change_factor: 2.0
* /move_group/planner_configs/TRRTkConfigDefault/type: geometric::TRRT
* /move_group/planning_plugin: ompl_interface/OM...
* /move_group/planning_scene_monitor/publish_geometry_updates: True
* /move_group/planning_scene_monitor/publish_planning_scene: True
* /move_group/planning_scene_monitor/publish_state_updates: True
* /move_group/planning_scene_monitor/publish_transforms_updates: True
* /move_group/request_adapters: default_planner_r...
* /move_group/start_state_max_bounds_error: 0.1
* /move_group/trajectory_execution/allowed_execution_duration_scaling: 1.5
* /move_group/trajectory_execution/allowed_goal_duration_margin: 0.5
* /move_group/trajectory_execution/allowed_start_tolerance: 0.01
* /position_joint_trajectory_controller/constraints/goal_time: 0.5
* /position_joint_trajectory_controller/constraints/panda_joint1/goal: 0.05
* /position_joint_trajectory_controller/constraints/panda_joint2/goal: 0.05
* /position_joint_trajectory_controller/constraints/panda_joint3/goal: 0.05
* /position_joint_trajectory_controller/constraints/panda_joint4/goal: 0.05
* /position_joint_trajectory_controller/constraints/panda_joint5/goal: 0.05
* /position_joint_trajectory_controller/constraints/panda_joint6/goal: 0.05
* /position_joint_trajectory_controller/constraints/panda_joint7/goal: 0.05
* /position_joint_trajectory_controller/joints: ['panda_joint1', ...
* /position_joint_trajectory_controller/type: position_controll...
* /robot_description: <?xml version="1....
* /robot_description_kinematics/panda_arm/kinematics_solver: kdl_kinematics_pl...
* /robot_description_kinematics/panda_arm/kinematics_solver_attempts: 3
* /robot_description_kinematics/panda_arm/kinematics_solver_search_resolution: 0.005
* /robot_description_kinematics/panda_arm/kinematics_solver_timeout: 0.005
* /robot_description_planning/joint_limits/panda_finger_joint1/has_acceleration_limits: False
* /robot_description_planning/joint_limits/panda_finger_joint1/has_velocity_limits: True
* /robot_description_planning/joint_limits/panda_finger_joint1/max_acceleration: 0
* /robot_description_planning/joint_limits/panda_finger_joint1/max_velocity: 0.1
* /robot_description_planning/joint_limits/panda_finger_joint2/has_acceleration_limits: False
* /robot_description_planning/joint_limits/panda_finger_joint2/has_velocity_limits: True
* /robot_description_planning/joint_limits/panda_finger_joint2/max_acceleration: 0
* /robot_description_planning/joint_limits/panda_finger_joint2/max_velocity: 0.1
* /robot_description_planning/joint_limits/panda_joint1/has_acceleration_limits: True
* /robot_description_planning/joint_limits/panda_joint1/has_velocity_limits: True
* /robot_description_planning/joint_limits/panda_joint1/max_acceleration: 3.75
* /robot_description_planning/joint_limits/panda_joint1/max_velocity: 2.175
* /robot_description_planning/joint_limits/panda_joint2/has_acceleration_limits: True
* /robot_description_planning/joint_limits/panda_joint2/has_velocity_limits: True
* /robot_description_planning/joint_limits/panda_joint2/max_acceleration: 1.875
* /robot_description_planning/joint_limits/panda_joint2/max_velocity: 2.175
* /robot_description_planning/joint_limits/panda_joint3/has_acceleration_limits: True
* /robot_description_planning/joint_limits/panda_joint3/has_velocity_limits: True
* /robot_description_planning/joint_limits/panda_joint3/max_acceleration: 2.5
* /robot_description_planning/joint_limits/panda_joint3/max_velocity: 2.175
* /robot_description_planning/joint_limits/panda_joint4/has_acceleration_limits: True
* /robot_description_planning/joint_limits/panda_joint4/has_velocity_limits: True
* /robot_description_planning/joint_limits/panda_joint4/max_acceleration: 3.125
* /robot_description_planning/joint_limits/panda_joint4/max_velocity: 2.175
* /robot_description_planning/joint_limits/panda_joint5/has_acceleration_limits: True
* /robot_description_planning/joint_limits/panda_joint5/has_velocity_limits: True
* /robot_description_planning/joint_limits/panda_joint5/max_acceleration: 3.75
* /robot_description_planning/joint_limits/panda_joint5/max_velocity: 2.61
* /robot_description_planning/joint_limits/panda_joint6/has_acceleration_limits: True
* /robot_description_planning/joint_limits/panda_joint6/has_velocity_limits: True
* /robot_description_planning/joint_limits/panda_joint6/max_acceleration: 5
* /robot_description_planning/joint_limits/panda_joint6/max_velocity: 2.61
* /robot_description_planning/joint_limits/panda_joint7/has_acceleration_limits: True
* /robot_description_planning/joint_limits/panda_joint7/has_velocity_limits: True
* /robot_description_planning/joint_limits/panda_joint7/max_acceleration: 5
* /robot_description_planning/joint_limits/panda_joint7/max_velocity: 2.61
* /robot_description_semantic: <?xml version="1....
* /rosdistro: kinetic
* /rosversion: 1.12.13
NODES
/
controller_spawner (controller_manager/spawner)
franka_control (franka_control/franka_control_node)
franka_gripper (franka_gripper/franka_gripper_node)
joint_state_publisher (joint_state_publisher/joint_state_publisher)
move_group (moveit_ros_move_group/move_group)
robot_state_publisher (robot_state_publisher/robot_state_publisher)
rviz (rviz/rviz)
state_controller_spawner (controller_manager/spawner)
auto-starting new master
process[master]: started with pid [8102]
ROS_MASTER_URI=http://localhost:11311
setting /run_id to eea78224-b294-11e8-b8bc-fcaa14212913
process[rosout-1]: started with pid [8115]
started core service [/rosout]
process[franka_gripper-2]: started with pid [8132]
process[franka_control-3]: started with pid [8133]
[ INFO] [1536321337.273408395]: franka_gripper_node: Found default_speed 0.1
[ INFO] [1536321337.273829217]: franka_gripper_node: Found default_grasp_epsilon inner: 0.005, outer: 0.005
process[state_controller_spawner-4]: started with pid [8146]
process[robot_state_publisher-5]: started with pid [8158]
process[joint_state_publisher-6]: started with pid [8168]
process[controller_spawner-7]: started with pid [8205]
process[move_group-8]: started with pid [8208]
process[rviz-9]: started with pid [8212]
[ INFO] [1536321337.404317405]: Loading robot model 'panda'...
[ INFO] [1536321337.404384868]: No root/virtual joint specified in SRDF. Assuming fixed joint
[ INFO] [1536321337.459558467]: Loading robot model 'panda'...
[ INFO] [1536321337.459589912]: No root/virtual joint specified in SRDF. Assuming fixed joint
[ INFO] [1536321337.495144343]: Publishing maintained planning scene on 'monitored_planning_scene'
[ INFO] [1536321337.497484900]: MoveGroup debug mode is OFF
Starting context monitors...
[ INFO] [1536321337.497515353]: Starting scene monitor
[ INFO] [1536321337.499884302]: Listening to '/planning_scene'
[ INFO] [1536321337.499904563]: Starting world geometry monitor
[ INFO] [1536321337.501762010]: Listening to '/collision_object' using message notifier with target frame '/panda_link0 '
[ INFO] [1536321337.503544876]: Listening to '/planning_scene_world' for planning scene world geometry
[ INFO] [1536321337.510268758]: Listening to '/attached_collision_object' for attached collision objects
Context monitors started.
[ INFO] [1536321337.531291578]: Initializing OMPL interface using ROS parameters
[INFO] [1536321337.550572]: Controller Spawner: Waiting for service controller_manager/load_controller
[INFO] [1536321337.552121]: Controller Spawner: Waiting for service controller_manager/switch_controller
[INFO] [1536321337.555162]: Controller Spawner: Waiting for service controller_manager/unload_controller
[INFO] [1536321337.556080]: Loading controller: franka_state_controller
[INFO] [1536321337.570932]: Controller Spawner: Waiting for service controller_manager/load_controller
[INFO] [1536321337.572040]: Controller Spawner: Waiting for service controller_manager/switch_controller
[INFO] [1536321337.572106]: Controller Spawner: Loaded controllers: franka_state_controller
[INFO] [1536321337.572992]: Controller Spawner: Waiting for service controller_manager/unload_controller
[INFO] [1536321337.573954]: Loading controller: position_joint_trajectory_controller
[INFO] [1536321337.575908]: Started controllers: franka_state_controller
[ INFO] [1536321337.592436869]: Using planning interface 'OMPL'
[ INFO] [1536321337.594454566]: Param 'default_workspace_bounds' was not set. Using default value: 10
[ INFO] [1536321337.594972242]: Param 'start_state_max_bounds_error' was set to 0.1
[ INFO] [1536321337.595569904]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1536321337.596261093]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1536321337.596739998]: Param 'jiggle_fraction' was set to 0.05
[ INFO] [1536321337.597324881]: Param 'max_sampling_attempts' was not set. Using default value: 100
[ INFO] [1536321337.597359062]: Using planning request adapter 'Add Time Parameterization'
[ INFO] [1536321337.597369322]: Using planning request adapter 'Fix Workspace Bounds'
[ INFO] [1536321337.597380529]: Using planning request adapter 'Fix Start State Bounds'
[ INFO] [1536321337.597390104]: Using planning request adapter 'Fix Start State In Collision'
[ INFO] [1536321337.597399456]: Using planning request adapter 'Fix Start State Path Constraints'
[INFO] [1536321337.618110]: Controller Spawner: Loaded controllers: position_joint_trajectory_controller
[ INFO] [1536321337.619771222]: FrankaHW: Prepared switching controllers to joint_positionwith parameters limit_rate=1, cutoff_frequency=100, internal_controller=cartesian_impedance
[INFO] [1536321337.621023]: Started controllers: position_joint_trajectory_controller
[ INFO] [1536321338.012789135]: Added FollowJointTrajectory controller for position_joint_trajectory_controller
[ INFO] [1536321338.316324496]: Added GripperCommand controller for franka_gripper
[ INFO] [1536321338.316379139]: Returned 2 controllers in list
[ INFO] [1536321338.325167709]: Trajectory execution is managing controllers
Loading 'move_group/ApplyPlanningSceneService'...
Loading 'move_group/ClearOctomapService'...
Loading 'move_group/MoveGroupCartesianPathService'...
Loading 'move_group/MoveGroupExecuteTrajectoryAction'...
Loading 'move_group/MoveGroupGetPlanningSceneService'...
Loading 'move_group/MoveGroupKinematicsService'...
Loading 'move_group/MoveGroupMoveAction'...
Loading 'move_group/MoveGroupPickPlaceAction'...
Loading 'move_group/MoveGroupPlanService'...
Loading 'move_group/MoveGroupQueryPlannersService'...
Loading 'move_group/MoveGroupStateValidationService'...
[ INFO] [1536321338.371855644]:
********************************************************
* MoveGroup using:
* - ApplyPlanningSceneService
* - ClearOctomapService
* - CartesianPathService
* - ExecuteTrajectoryAction
* - GetPlanningSceneService
* - KinematicsService
* - MoveAction
* - PickPlaceAction
* - MotionPlanService
* - QueryPlannersService
* - StateValidationService
********************************************************
[ INFO] [1536321338.371922062]: MoveGroup context using planning plugin ompl_interface/OMPLPlanner
[ INFO] [1536321338.371937498]: MoveGroup context initialization complete
You can start planning now!
Which is the normal procedure, but when i try to plan the Trajectory it fails on the RVIZ and then the outcome in the terminal is:
[ INFO] [1536321422.185812818]: Didn't received robot state (joint angles) with recent timestamp within 1 seconds.
Check clock synchronization if your are running ROS across multiple machines!
[ WARN] [1536321422.185850586]: Failed to fetch current robot state.
[ INFO] [1536321422.185949175]: Planning request received for MoveGroup action. Forwarding to planning pipeline.
[ INFO] [1536321422.186817540]: Planner configuration 'panda_arm' will use planner 'geometric::RRTConnect'. Additional configuration parameters will be set when the planner is constructed.
[ INFO] [1536321422.187489704]: RRTConnect: Starting planning with 1 states already in datastructure
[ INFO] [1536321422.187518384]: RRTConnect: Starting planning with 1 states already in datastructure
[ INFO] [1536321422.187718111]: RRTConnect: Starting planning with 1 states already in datastructure
[ INFO] [1536321422.187858598]: RRTConnect: Starting planning with 1 states already in datastructure
[ INFO] [1536321422.188486888]: RRTConnect: Created 4 states (2 start + 2 goal)
[ INFO] [1536321422.188818961]: RRTConnect: Created 5 states (2 start + 3 goal)
[ INFO] [1536321422.188849838]: RRTConnect: Created 5 states (2 start + 3 goal)
[ INFO] [1536321422.189231829]: RRTConnect: Created 5 states (2 start + 3 goal)
[ INFO] [1536321422.189300566]: ParallelPlan::solve(): Solution found by one or more threads in 0.002178 seconds
[ INFO] [1536321422.189434396]: RRTConnect: Starting planning with 1 states already in datastructure
[ INFO] [1536321422.190212375]: RRTConnect: Created 5 states (2 start + 3 goal)
[ INFO] [1536321422.190289519]: RRTConnect: Starting planning with 1 states already in datastructure
[ INFO] [1536321422.190828059]: RRTConnect: Created 4 states (2 start + 2 goal)
[ INFO] [1536321422.190895003]: RRTConnect: Starting planning with 1 states already in datastructure
[ INFO] [1536321422.191551546]: RRTConnect: Created 5 states (2 start + 3 goal)
[ INFO] [1536321422.191631848]: RRTConnect: Starting planning with 1 states already in datastructure
[ INFO] [1536321422.192341714]: RRTConnect: Created 5 states (2 start + 3 goal)
[ INFO] [1536321422.192411808]: ParallelPlan::solve(): Solution found by one or more threads in 0.003008 seconds
[ INFO] [1536321422.192492039]: RRTConnect: Starting planning with 1 states already in datastructure
[ INFO] [1536321422.193174956]: RRTConnect: Created 5 states (2 start + 3 goal)
[ INFO] [1536321422.193265500]: RRTConnect: Starting planning with 1 states already in datastructure
[ INFO] [1536321422.193864332]: RRTConnect: Created 4 states (2 start + 2 goal)
[ INFO] [1536321422.193929904]: ParallelPlan::solve(): Solution found by one or more threads in 0.001459 seconds
[ INFO] [1536321422.198831537]: SimpleSetup: Path simplification took 0.004840 seconds and changed from 3 to 2 states
[ INFO] [1536321424.887098971]: Execution request received
[ INFO] [1536321425.887293764]: Didn't received robot state (joint angles) with recent timestamp within 1 seconds.
Check clock synchronization if your are running ROS across multiple machines!
[ WARN] [1536321425.887331188]: Failed to validate trajectory: couldn't receive full current joint state within 1s
[ INFO] [1536321425.887363066]: Execution completed: ABORTED
I have the rqt_graph but could not upload it because i don't have enough points for it. By the way on the Franka interface the robot is connected and functional, the problem is a ROS thing.
Asked by hpoleselo on 2018-09-07 07:26:17 UTC
Answers
I found the error, for some reason there was a remapping on '/opt/ros/kinetic/share/panda_moveit_config/launch/move_group.launch' the remapping was:
<remap from="/joint_states" to="/joint_states_desired" />
This resulted on the fact that /joint_states was not publishing to /move_group. So i just commented this part and now the robot is planning and executing smoothly again.
i didn't check the original package from Github, but i think it's already there (with this remapping)...
Asked by hpoleselo on 2018-09-13 09:29:45 UTC
Comments
I ran across the same problem and can confirm this solution works. As the file was in a protected folder, I copied it and removed the line. Then I changed the path within the main launch file to the unprotected version of move_group.launch. It seems that this line is there in the original package (move_group.launch on GitHub). I don't know why they put it there. It looks like this might be needed when working with Gazebo (see point 6 here), but as far as my understanding of this package goes, that line is not there on purpose. I will post an issue on the GitHub page and ask if this is intended.
Asked by Gnr on 2019-08-02 06:06:32 UTC
Comments