Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- $ roslaunch fetch_pbd_interaction pbd.launch
- ... logging to /home/ruffsl/.ros/log/58547894-f22f-11e6-9460-d8cb8a401fcc/roslaunch-fetch33-8755.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.
- started roslaunch server http://fetch33:41774/
- SUMMARY
- ========
- PARAMETERS
- * /from_file:
- * /move_group/allow_trajectory_execution: True
- * /move_group/allowed_execution_duration_scaling: 1.2
- * /move_group/allowed_goal_duration_margin: 0.5
- * /move_group/arm/longest_valid_segment_fraction: 0.05
- * /move_group/arm/planner_configs: ['SBLkConfigDefau...
- * /move_group/arm/projection_evaluator: joints(shoulder_p...
- * /move_group/arm_with_torso/longest_valid_segment_fraction: 0.05
- * /move_group/arm_with_torso/planner_configs: ['SBLkConfigDefau...
- * /move_group/arm_with_torso/projection_evaluator: joints(torso_lift...
- * /move_group/capabilities: move_group/MoveGr...
- * /move_group/controller_list: [{'default': True...
- * /move_group/gripper/planner_configs: ['SBLkConfigDefau...
- * /move_group/jiggle_fraction: 0.05
- * /move_group/max_safe_path_cost: 1
- * /move_group/moveit_controller_manager: moveit_simple_con...
- * /move_group/moveit_manage_controllers: True
- * /move_group/planner_configs/BKPIECEkConfigDefault/type: geometric::BKPIECE
- * /move_group/planner_configs/ESTkConfigDefault/type: geometric::EST
- * /move_group/planner_configs/KPIECEkConfigDefault/type: geometric::KPIECE
- * /move_group/planner_configs/LBKPIECEkConfigDefault/type: geometric::LBKPIECE
- * /move_group/planner_configs/PRMkConfigDefault/type: geometric::PRM
- * /move_group/planner_configs/PRMstarkConfigDefault/type: geometric::PRMstar
- * /move_group/planner_configs/RRTConnectkConfigDefault/type: geometric::RRTCon...
- * /move_group/planner_configs/RRTkConfigDefault/type: geometric::RRT
- * /move_group/planner_configs/RRTstarkConfigDefault/type: geometric::RRTstar
- * /move_group/planner_configs/SBLkConfigDefault/type: geometric::SBL
- * /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
- * /play_sound: True
- * /rail_segmentation/max_cluster_size: 50000
- * /rail_segmentation/point_cloud_topic: head_camera/depth...
- * /rail_segmentation/zones_config: /home/ruffsl/work...
- * /robot_description_kinematics/arm/kinematics_solver: kdl_kinematics_pl...
- * /robot_description_kinematics/arm/kinematics_solver_attempts: 3
- * /robot_description_kinematics/arm/kinematics_solver_search_resolution: 0.005
- * /robot_description_kinematics/arm/kinematics_solver_timeout: 0.005
- * /robot_description_kinematics/arm_with_torso/kinematics_solver: kdl_kinematics_pl...
- * /robot_description_kinematics/arm_with_torso/kinematics_solver_attempts: 3
- * /robot_description_kinematics/arm_with_torso/kinematics_solver_search_resolution: 0.005
- * /robot_description_kinematics/arm_with_torso/kinematics_solver_timeout: 0.005
- * /robot_description_planning/joint_limits/elbow_flex_joint/has_acceleration_limits: True
- * /robot_description_planning/joint_limits/elbow_flex_joint/has_velocity_limits: True
- * /robot_description_planning/joint_limits/elbow_flex_joint/max_acceleration: 1.5
- * /robot_description_planning/joint_limits/elbow_flex_joint/max_velocity: 1.5
- * /robot_description_planning/joint_limits/forearm_roll_joint/has_acceleration_limits: True
- * /robot_description_planning/joint_limits/forearm_roll_joint/has_velocity_limits: True
- * /robot_description_planning/joint_limits/forearm_roll_joint/max_acceleration: 1.5
- * /robot_description_planning/joint_limits/forearm_roll_joint/max_velocity: 1.57
- * /robot_description_planning/joint_limits/left_gripper_joint/has_acceleration_limits: False
- * /robot_description_planning/joint_limits/left_gripper_joint/has_velocity_limits: False
- * /robot_description_planning/joint_limits/left_gripper_joint/max_acceleration: 0
- * /robot_description_planning/joint_limits/left_gripper_joint/max_velocity: 0
- * /robot_description_planning/joint_limits/right_gripper_joint/has_acceleration_limits: False
- * /robot_description_planning/joint_limits/right_gripper_joint/has_velocity_limits: False
- * /robot_description_planning/joint_limits/right_gripper_joint/max_acceleration: 0
- * /robot_description_planning/joint_limits/right_gripper_joint/max_velocity: 0
- * /robot_description_planning/joint_limits/shoulder_lift_joint/has_acceleration_limits: True
- * /robot_description_planning/joint_limits/shoulder_lift_joint/has_velocity_limits: True
- * /robot_description_planning/joint_limits/shoulder_lift_joint/max_acceleration: 1.0
- * /robot_description_planning/joint_limits/shoulder_lift_joint/max_velocity: 1.0
- * /robot_description_planning/joint_limits/shoulder_pan_joint/has_acceleration_limits: True
- * /robot_description_planning/joint_limits/shoulder_pan_joint/has_velocity_limits: True
- * /robot_description_planning/joint_limits/shoulder_pan_joint/max_acceleration: 1.5
- * /robot_description_planning/joint_limits/shoulder_pan_joint/max_velocity: 1.256
- * /robot_description_planning/joint_limits/torso_lift_joint/has_acceleration_limits: True
- * /robot_description_planning/joint_limits/torso_lift_joint/has_velocity_limits: True
- * /robot_description_planning/joint_limits/torso_lift_joint/max_acceleration: 0.5
- * /robot_description_planning/joint_limits/torso_lift_joint/max_velocity: 0.1
- * /robot_description_planning/joint_limits/upperarm_roll_joint/has_acceleration_limits: True
- * /robot_description_planning/joint_limits/upperarm_roll_joint/has_velocity_limits: True
- * /robot_description_planning/joint_limits/upperarm_roll_joint/max_acceleration: 1.5
- * /robot_description_planning/joint_limits/upperarm_roll_joint/max_velocity: 1.57
- * /robot_description_planning/joint_limits/wrist_flex_joint/has_acceleration_limits: True
- * /robot_description_planning/joint_limits/wrist_flex_joint/has_velocity_limits: True
- * /robot_description_planning/joint_limits/wrist_flex_joint/max_acceleration: 2.5
- * /robot_description_planning/joint_limits/wrist_flex_joint/max_velocity: 2.26
- * /robot_description_planning/joint_limits/wrist_roll_joint/has_acceleration_limits: True
- * /robot_description_planning/joint_limits/wrist_roll_joint/has_velocity_limits: True
- * /robot_description_planning/joint_limits/wrist_roll_joint/max_acceleration: 2.5
- * /robot_description_planning/joint_limits/wrist_roll_joint/max_velocity: 2.26
- * /robot_description_semantic: <?xml version="1....
- * /rosbridge_websocket/address:
- * /rosbridge_websocket/authenticate: False
- * /rosbridge_websocket/delay_between_messages: 0
- * /rosbridge_websocket/fragment_timeout: 600
- * /rosbridge_websocket/max_message_size: None
- * /rosbridge_websocket/port: 9090
- * /rosbridge_websocket/retry_startup_delay: 5
- * /rosdistro: indigo
- * /rosversion: 1.11.20
- * /social_gaze: True
- * /to_file:
- NODES
- /
- fetch_pbd_arm_control (fetch_pbd_interaction/pbd_arm_control_node.py)
- fetch_pbd_interaction (fetch_pbd_interaction/pbd_interaction_node.py)
- fetch_social_gaze (fetch_social_gaze/social_gaze_server.py)
- marker_proxy_1 (interactive_marker_proxy/proxy)
- marker_proxy_2 (interactive_marker_proxy/proxy)
- move_group (moveit_ros_move_group/move_group)
- pbd_world_node (fetch_pbd_interaction/pbd_world_node.py)
- rail_segmentation (rail_segmentation/rail_segmentation)
- rosapi (rosapi/rosapi_node)
- rosbridge_websocket (rosbridge_server/rosbridge_websocket)
- serve_web_interface (fetch_pbd_interaction/serve_web_interface.sh)
- tf2_web_republisher (tf2_web_republisher/tf2_web_republisher)
- ROS_MASTER_URI=http://localhost:11311
- core service [/rosout] found
- running rosparam delete /move_group/sensors
- ERROR: parameter [/move_group/sensors] is not set
- process[fetch_social_gaze-1]: started with pid [8778]
- process[rosbridge_websocket-2]: started with pid [8779]
- process[rosapi-3]: started with pid [8780]
- process[marker_proxy_1-4]: started with pid [8781]
- process[marker_proxy_2-5]: started with pid [8782]
- process[tf2_web_republisher-6]: started with pid [8805]
- [ INFO] [1487019823.167375468]: Subscribing to /world_objects
- [ INFO] [1487019823.167429790]: Target frame set to /base_link
- registered capabilities (classes):
- - rosbridge_library.capabilities.call_service.CallService
- - rosbridge_library.capabilities.advertise.Advertise
- - rosbridge_library.capabilities.publish.Publish
- - rosbridge_library.capabilities.subscribe.Subscribe
- - <class 'rosbridge_library.capabilities.defragmentation.Defragment'>
- - rosbridge_library.capabilities.advertise_service.AdvertiseService
- - rosbridge_library.capabilities.service_response.ServiceResponse
- - rosbridge_library.capabilities.unadvertise_service.UnadvertiseService
- [ INFO] [1487019823.177040721]: Subscribing to /programmed_actions
- [ INFO] [1487019823.177131895]: Target frame set to /base_link
- [ INFO] [1487019823.185517044]: (INFO) General: Waiting for messages.
- [ INFO] [1487019823.193533976]: (INFO) General: Waiting for messages.
- [INFO] [WallTime: 1487019823.354211] Rosbridge WebSocket server started on port 9090
- [INFO] [WallTime: 1487019823.568541] Head action client has responded.
- process[serve_web_interface-7]: started with pid [9023]
- process[move_group-8]: started with pid [9025]
- process[rail_segmentation-9]: started with pid [9026]
- [ INFO] [1487019823.682865246]: 1 segmenation zone(s) parsed.
- [ INFO] [1487019823.682926152]: Segmenter Successfully Initialized
- [ INFO] [1487019823.708907681]: Loading robot model 'fetch'...
- [ INFO] [1487019823.708978870]: No root joint specified. Assuming fixed joint
- [ INFO] [1487019823.831748224]: Loading robot model 'fetch'...
- [ INFO] [1487019823.831795604]: No root joint specified. Assuming fixed joint
- [ WARN] [1487019823.872498233]: The root link base_link has an inertia specified in the URDF, but KDL does not support a root link with an inertia. As a workaround, you can add an extra dummy link to your URDF.
- [ INFO] [1487019823.880168856]: Loading robot model 'fetch'...
- [ INFO] [1487019823.880262951]: No root joint specified. Assuming fixed joint
- [ WARN] [1487019823.918921493]: The root link base_link has an inertia specified in the URDF, but KDL does not support a root link with an inertia. As a workaround, you can add an extra dummy link to your URDF.
- [ INFO] [1487019824.063741408]: Publishing maintained planning scene on 'monitored_planning_scene'
- [ INFO] [1487019824.066382229]: MoveGroup debug mode is OFF
- Starting context monitors...
- [ INFO] [1487019824.066409149]: Starting scene monitor
- [ INFO] [1487019824.068961092]: Listening to '/planning_scene'
- [ INFO] [1487019824.068988964]: Starting world geometry monitor
- [ INFO] [1487019824.071527147]: Listening to '/collision_object' using message notifier with target frame '/base_link '
- [ INFO] [1487019824.073840021]: Listening to '/planning_scene_world' for planning scene world geometry
- [ WARN] [1487019824.074264129]: Resolution not specified for Octomap. Assuming resolution = 0.1 instead
- process[fetch_pbd_arm_control-10]: started with pid [9351]
- [ INFO] [1487019824.241926291]: Listening to '/attached_collision_object' for attached collision objects
- Context monitors started.
- [ INFO] [1487019824.284279019]: Initializing OMPL interface using ROS parameters
- [ INFO] [1487019824.316609269]: Using planning interface 'OMPL'
- [ INFO] [1487019824.340410476]: Param 'default_workspace_bounds' was not set. Using default value: 10
- [ INFO] [1487019824.341093291]: Param 'start_state_max_bounds_error' was set to 0.1
- [ INFO] [1487019824.341662295]: Param 'start_state_max_dt' was not set. Using default value: 0.5
- [ INFO] [1487019824.342209798]: Param 'start_state_max_dt' was not set. Using default value: 0.5
- [ INFO] [1487019824.342739095]: Param 'jiggle_fraction' was set to 0.05
- [ INFO] [1487019824.343287265]: Param 'max_sampling_attempts' was not set. Using default value: 100
- [ INFO] [1487019824.343333377]: Using planning request adapter 'Add Time Parameterization'
- [ INFO] [1487019824.343349389]: Using planning request adapter 'Fix Workspace Bounds'
- [ INFO] [1487019824.343361074]: Using planning request adapter 'Fix Start State Bounds'
- [ INFO] [1487019824.343371982]: Using planning request adapter 'Fix Start State In Collision'
- [ INFO] [1487019824.343382533]: Using planning request adapter 'Fix Start State Path Constraints'
- [ INFO] [1487019824.602342213]: Added FollowJointTrajectory controller for arm_controller
- process[pbd_world_node-11]: started with pid [9543]
- [ INFO] [1487019824.874086751]: Added FollowJointTrajectory controller for arm_with_torso_controller
- [INFO] [WallTime: 1487019824.962289] Removing surface
- process[fetch_pbd_interaction-12]: started with pid [9659]
- [ INFO] [1487019825.179903511]: Added GripperCommand controller for gripper_controller
- [ INFO] [1487019825.179957019]: Returned 3 controllers in list
- [ INFO] [1487019825.196790350]: Trajectory execution is managing controllers
- Loading 'move_group/MoveGroupCartesianPathService'...
- Loading 'move_group/MoveGroupExecuteService'...
- Loading 'move_group/MoveGroupKinematicsService'...
- Loading 'move_group/MoveGroupMoveAction'...
- Loading 'move_group/MoveGroupPickPlaceAction'...
- [ WARN] [1487019825.263650755]: MessageFilter [target=/base_link ]: Discarding message from [/pbd_world_node] due to empty frame_id. This message will only print once.
- Loading 'move_group/MoveGroupPlanService'...
- Loading 'move_group/MoveGroupQueryPlannersService'...
- Loading 'move_group/MoveGroupStateValidationService'...
- Loading 'move_group/MoveGroupGetPlanningSceneService'...
- Loading 'move_group/ClearOctomapService'...
- [ INFO] [1487019825.306081890]:
- ********************************************************
- * MoveGroup using:
- * - CartesianPathService
- * - ExecutePathService
- * - KinematicsService
- * - MoveAction
- * - PickPlaceAction
- * - MotionPlanService
- * - QueryPlannersService
- * - StateValidationService
- * - GetPlanningSceneService
- * - ClearOctomapService
- ********************************************************
- [ INFO] [1487019825.306159681]: MoveGroup context using planning plugin ompl_interface/OMPLPlanner
- [ INFO] [1487019825.306177382]: MoveGroup context initialization complete
- All is well! Everyone is happy! You can start planning now!
- [ INFO] [1487019825.407995695]: Loading robot model 'fetch'...
- [ INFO] [1487019825.408032558]: No root joint specified. Assuming fixed joint
- [ INFO] [1487019825.441187197]: (INFO) General: Receiving messages.
- [ INFO] [1487019825.441226870]: (INFO) /pbd_world_node: Waiting for init message.
- [ INFO] [1487019825.569837214]: Loading robot model 'fetch'...
- [ INFO] [1487019825.569888016]: No root joint specified. Assuming fixed joint
- [ INFO] [1487019825.585063412]: (INFO) /pbd_world_node: Init message received.
- [ INFO] [1487019825.595505817]: (INFO) /pbd_world_node: Receiving updates.
- [ WARN] [1487019825.610984243]: The root link base_link has an inertia specified in the URDF, but KDL does not support a root link with an inertia. As a workaround, you can add an extra dummy link to your URDF.
- [ INFO] [1487019825.616491827]: Loading robot model 'fetch'...
- [ INFO] [1487019825.616610734]: No root joint specified. Assuming fixed joint
- [ WARN] [1487019825.656891830]: The root link base_link has an inertia specified in the URDF, but KDL does not support a root link with an inertia. As a workaround, you can add an extra dummy link to your URDF.
- [ INFO] [1487019826.396797184]: Ready to take MoveGroup commands for group arm.
- [INFO] [WallTime: 1487019828.147952] Arm initialized.
- [INFO] [WallTime: 1487019828.291514] Got all arm services
- [INFO] [WallTime: 1487019828.369845] Got all head services
- [INFO] [WallTime: 1487019828.370963] Got all world services
- Traceback (most recent call last):
- File "/home/ruffsl/workspaces/fetchrobotics/src/fetch_pbd/fetch_pbd_interaction/nodes/pbd_interaction_node.py", line 28, in <module>
- interaction = Interaction()
- File "/home/ruffsl/workspaces/fetchrobotics/src/fetch_pbd/fetch_pbd_interaction/src/fetch_pbd_interaction/interaction.py", line 61, in __init__
- self._im_server)
- File "/home/ruffsl/workspaces/fetchrobotics/src/fetch_pbd/fetch_pbd_interaction/src/fetch_pbd_interaction/session.py", line 67, in __init__
- self._db = self._couch.create('fetch_pbd')
- File "/usr/lib/python2.7/dist-packages/couchdb/client.py", line 193, in create
- self.resource.put_json(validate_dbname(name))
- File "/usr/lib/python2.7/dist-packages/couchdb/http.py", line 405, in put_json
- status, headers, data = self.put(*a, **k)
- File "/usr/lib/python2.7/dist-packages/couchdb/http.py", line 384, in put
- return self._request('PUT', path, body=body, headers=headers, **params)
- File "/usr/lib/python2.7/dist-packages/couchdb/http.py", line 419, in _request
- credentials=self.credentials)
- File "/usr/lib/python2.7/dist-packages/couchdb/http.py", line 239, in request
- resp = _try_request_with_retries(iter(self.retry_delays))
- File "/usr/lib/python2.7/dist-packages/couchdb/http.py", line 205, in _try_request_with_retries
- raise e
- socket.error: [Errno 111] Connection refused
- terminate called after throwing an instance of 'boost::exception_detail::clone_impl<boost::exception_detail::error_info_injector<boost::lock_error> >'
- what(): boost: mutex lock failed in pthread_mutex_lock: Invalid argument
- [fetch_pbd_interaction-12] process has died [pid 9659, exit code -6, cmd /home/ruffsl/workspaces/fetchrobotics/src/fetch_pbd/fetch_pbd_interaction/nodes/pbd_interaction_node.py __name:=fetch_pbd_interaction __log:=/home/ruffsl/.ros/log/58547894-f22f-11e6-9460-d8cb8a401fcc/fetch_pbd_interaction-12.log].
- log file: /home/ruffsl/.ros/log/58547894-f22f-11e6-9460-d8cb8a401fcc/fetch_pbd_interaction-12*.log
- [INFO] [WallTime: 1487019840.340729] Client connected. 1 clients total.
- [INFO] [WallTime: 1487019840.587644] [Client 0] Subscribed to /page_change
- [INFO] [WallTime: 1487019840.657251] Client connected. 2 clients total.
- [INFO] [WallTime: 1487019840.872902] [Client 1] Subscribed to /session_state
- [ERROR] [WallTime: 1487019840.874794] [Client 1] [id: call_service:/get_session_state:2] call_service InvalidServiceException: Service /get_session_state does not exist
- [INFO] [WallTime: 1487019848.160668] Client connected. 3 clients total.
- [INFO] [WallTime: 1487019848.303786] [Client 2] Subscribed to /tf2_web_republisher/feedback
- [INFO] [WallTime: 1487019848.311840] [Client 2] Subscribed to /visualization_marker_array
- [INFO] [WallTime: 1487019848.326918] [Client 2] Subscribed to programmed_actions/tunneled/update
- [ INFO] [1487019848.344253364]: Init requested.
- [INFO] [WallTime: 1487019848.345952] [Client 2] Subscribed to world_objects/tunneled/update
- [INFO] [WallTime: 1487019848.362802] [Client 2] Subscribed to /session_state
- [ERROR] [WallTime: 1487019848.363283] [Client 2] [id: call_service:/get_session_state:12] call_service InvalidServiceException: Service /get_session_state does not exist
- [ INFO] [1487019848.365333883]: Init requested.
- [INFO] [WallTime: 1487019848.371128] [Client 2] Subscribed to /fetch_pbd_status
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement