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

ex52_buildable_bricks_within_reach stops working after 1st brick #9

Open
Achillx opened this issue Feb 12, 2019 · 0 comments
Open

ex52_buildable_bricks_within_reach stops working after 1st brick #9

Achillx opened this issue Feb 12, 2019 · 0 comments

Comments

@Achillx
Copy link

Achillx commented Feb 12, 2019

When I run the example it loads the sequence
sequence [3, 2, 1, 0, 8, 7, 6, 5, 13, 12, 11, 18, 17, 16, 23, 22, 28, 27, 33]
resolves the 1st brick
Brick with key 3 is buildable
and then it stucks.

I'm using the docker-compose.yml from ros-abb-linear-axis folder.

macOS 10.14.2 (18C54)
Visual studio Code
compas 0.4.10
compas_fab 0.4.0
compas_assembly 0.1.7

The log of the ros-bridge:

docker logs -f 423fdf1571191b6aaec466bf4559fb74b3eff8c3cb72ab796c681280eeaf704a
(base) axydis@~/PROJECTS/python/robotic_assembly_workshop$ docker logs -f 423fdf1571191b6aaec466bf4559fb74b3eff8c3cb72ab796c681280eeaf704a
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] [1549987033.096916]: Rosbridge WebSocket server started on port 9090
[INFO] [1549987074.731928]: Client connected.  1 clients total.
[INFO] [1549987169.388349]: Client disconnected. 0 clients total.
master has started, initiating launch
... logging to /root/.ros/log/db227882-2ede-11e9-afc3-0242c0a83002/roslaunch-423fdf157119-1.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://ros-bridge:46523/

SUMMARY
========

PARAMETERS
 * /rosapi/params_glob: [*]
 * /rosapi/services_glob: [*]
 * /rosapi/topics_glob: [*]
 * /rosbridge_websocket/address: 
 * /rosbridge_websocket/authenticate: False
 * /rosbridge_websocket/bson_only_mode: False
 * /rosbridge_websocket/delay_between_messages: 0
 * /rosbridge_websocket/fragment_timeout: 600
 * /rosbridge_websocket/max_message_size: None
 * /rosbridge_websocket/params_glob: [*]
 * /rosbridge_websocket/port: 9090
 * /rosbridge_websocket/retry_startup_delay: 5
 * /rosbridge_websocket/services_glob: [*]
 * /rosbridge_websocket/topics_glob: [*]
 * /rosbridge_websocket/unregister_timeout: 10
 * /rosbridge_websocket/use_compression: False
 * /rosdistro: kinetic
 * /rosversion: 1.12.14

NODES
  /
    rosapi (rosapi/rosapi_node)
    rosbridge_websocket (rosbridge_server/rosbridge_websocket)

ROS_MASTER_URI=http://ros-master:11311

process[rosbridge_websocket-1]: started with pid [60]
process[rosapi-2]: started with pid [61]
[rosapi-2] killing on exit
[rosbridge_websocket-1] killing on exit
shutting down processing monitor...
... shutting down processing monitor complete
done
source /Users/axydis/anaconda2/bin/activate
conda activate workshop

the log of ros-fileserver:

(base) axydis@~/PROJECTS/python/robotic_assembly_workshop$ docker logs -f 739a265eb0a1913e5179fa6a891b0fe49e58c5a058194b586efa213ef2ac7390
[ INFO] [1549987032.448153974]: ROSbridge File Server initialized.
master has started, initiating launch
... logging to /root/.ros/log/db227882-2ede-11e9-afc3-0242c0a83002/roslaunch-739a265eb0a1-1.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://ros-fileserver:45641/

SUMMARY
========

PARAMETERS
 * /rosdistro: kinetic
 * /rosversion: 1.12.14

NODES
  /
    file_server (file_server/file_server)

ROS_MASTER_URI=http://ros-master:11311

process[file_server-1]: started with pid [60]
[file_server-1] killing on exit
shutting down processing monitor...
... shutting down processing monitor complete
done
source /Users/axydis/anaconda2/bin/activate
conda activate workshop

the log of abb-linear-axis:

(base) axydis@~/PROJECTS/python/robotic_assembly_workshop$ docker logs -f 743008dbe2c7ae3af418a22c37857edb84d985f4da1723afd3d1d505d887a801
roscore/master is not yet running, will wait for it to start
master has started, initiating launch
... logging to /root/.ros/log/db227882-2ede-11e9-afc3-0242c0a83002/roslaunch-743008dbe2c7-1.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://abb-linear-axis-planner:43831/

SUMMARY
========

PARAMETERS
 * /joint_state_publisher/source_list: ['move_group/fake...
 * /joint_state_publisher/use_gui: False
 * /move_group/abb/default_planner_config: RRT
 * /move_group/abb/longest_valid_segment_fraction: 0.005
 * /move_group/abb/planner_configs: ['SBL', 'EST', 'L...
 * /move_group/abb/projection_evaluator: joints(joint_1,jo...
 * /move_group/allow_trajectory_execution: True
 * /move_group/axis_abb/default_planner_config: RRT
 * /move_group/axis_abb/planner_configs: ['SBL', 'EST', 'L...
 * /move_group/capabilities: 
 * /move_group/controller_list: [{'joints': ['axi...
 * /move_group/disable_capabilities: 
 * /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_fake_contr...
 * /move_group/moveit_manage_controllers: True
 * /move_group/octomap_resolution: 0.025
 * /move_group/planner_configs/BFMT/balanced: 0
 * /move_group/planner_configs/BFMT/cache_cc: 1
 * /move_group/planner_configs/BFMT/extended_fmt: 1
 * /move_group/planner_configs/BFMT/heuristics: 1
 * /move_group/planner_configs/BFMT/nearest_k: 1
 * /move_group/planner_configs/BFMT/num_samples: 1000
 * /move_group/planner_configs/BFMT/optimality: 1
 * /move_group/planner_configs/BFMT/radius_multiplier: 1.0
 * /move_group/planner_configs/BFMT/type: geometric::BFMT
 * /move_group/planner_configs/BKPIECE/border_fraction: 0.9
 * /move_group/planner_configs/BKPIECE/failed_expansion_score_factor: 0.5
 * /move_group/planner_configs/BKPIECE/min_valid_path_fraction: 0.5
 * /move_group/planner_configs/BKPIECE/range: 0.0
 * /move_group/planner_configs/BKPIECE/type: geometric::BKPIECE
 * /move_group/planner_configs/BiEST/range: 0.0
 * /move_group/planner_configs/BiEST/type: geometric::BiEST
 * /move_group/planner_configs/BiTRRT/cost_threshold: 1e300
 * /move_group/planner_configs/BiTRRT/frountier_node_ratio: 0.1
 * /move_group/planner_configs/BiTRRT/frountier_threshold: 0.0
 * /move_group/planner_configs/BiTRRT/init_temperature: 100
 * /move_group/planner_configs/BiTRRT/range: 0.0
 * /move_group/planner_configs/BiTRRT/temp_change_factor: 0.1
 * /move_group/planner_configs/BiTRRT/type: geometric::BiTRRT
 * /move_group/planner_configs/EST/goal_bias: 0.05
 * /move_group/planner_configs/EST/range: 0.0
 * /move_group/planner_configs/EST/type: geometric::EST
 * /move_group/planner_configs/FMT/cache_cc: 1
 * /move_group/planner_configs/FMT/extended_fmt: 1
 * /move_group/planner_configs/FMT/heuristics: 0
 * /move_group/planner_configs/FMT/nearest_k: 1
 * /move_group/planner_configs/FMT/num_samples: 1000
 * /move_group/planner_configs/FMT/radius_multiplier: 1.1
 * /move_group/planner_configs/FMT/type: geometric::FMT
 * /move_group/planner_configs/KPIECE/border_fraction: 0.9
 * /move_group/planner_configs/KPIECE/failed_expansion_score_factor: 0.5
 * /move_group/planner_configs/KPIECE/goal_bias: 0.05
 * /move_group/planner_configs/KPIECE/min_valid_path_fraction: 0.5
 * /move_group/planner_configs/KPIECE/range: 0.0
 * /move_group/planner_configs/KPIECE/type: geometric::KPIECE
 * /move_group/planner_configs/LBKPIECE/border_fraction: 0.9
 * /move_group/planner_configs/LBKPIECE/min_valid_path_fraction: 0.5
 * /move_group/planner_configs/LBKPIECE/range: 0.0
 * /move_group/planner_configs/LBKPIECE/type: geometric::LBKPIECE
 * /move_group/planner_configs/LBTRRT/epsilon: 0.4
 * /move_group/planner_configs/LBTRRT/goal_bias: 0.05
 * /move_group/planner_configs/LBTRRT/range: 0.0
 * /move_group/planner_configs/LBTRRT/type: geometric::LBTRRT
 * /move_group/planner_configs/LazyPRM/range: 0.0
 * /move_group/planner_configs/LazyPRM/type: geometric::LazyPRM
 * /move_group/planner_configs/LazyPRMstar/type: geometric::LazyPR...
 * /move_group/planner_configs/PDST/type: geometric::PDST
 * /move_group/planner_configs/PRM/max_nearest_neighbors: 10
 * /move_group/planner_configs/PRM/type: geometric::PRM
 * /move_group/planner_configs/PRMstar/type: geometric::PRMstar
 * /move_group/planner_configs/ProjEST/goal_bias: 0.05
 * /move_group/planner_configs/ProjEST/range: 0.0
 * /move_group/planner_configs/ProjEST/type: geometric::ProjEST
 * /move_group/planner_configs/RRT/goal_bias: 0.05
 * /move_group/planner_configs/RRT/range: 0.0
 * /move_group/planner_configs/RRT/type: geometric::RRT
 * /move_group/planner_configs/RRTConnect/range: 0.0
 * /move_group/planner_configs/RRTConnect/type: geometric::RRTCon...
 * /move_group/planner_configs/RRTstar/delay_collision_checking: 1
 * /move_group/planner_configs/RRTstar/goal_bias: 0.05
 * /move_group/planner_configs/RRTstar/range: 0.0
 * /move_group/planner_configs/RRTstar/type: geometric::RRTstar
 * /move_group/planner_configs/SBL/range: 0.0
 * /move_group/planner_configs/SBL/type: geometric::SBL
 * /move_group/planner_configs/SPARS/dense_delta_fraction: 0.001
 * /move_group/planner_configs/SPARS/max_failures: 1000
 * /move_group/planner_configs/SPARS/sparse_delta_fraction: 0.25
 * /move_group/planner_configs/SPARS/stretch_factor: 3.0
 * /move_group/planner_configs/SPARS/type: geometric::SPARS
 * /move_group/planner_configs/SPARStwo/dense_delta_fraction: 0.001
 * /move_group/planner_configs/SPARStwo/max_failures: 5000
 * /move_group/planner_configs/SPARStwo/sparse_delta_fraction: 0.25
 * /move_group/planner_configs/SPARStwo/stretch_factor: 3.0
 * /move_group/planner_configs/SPARStwo/type: geometric::SPARStwo
 * /move_group/planner_configs/STRIDE/degree: 16
 * /move_group/planner_configs/STRIDE/estimated_dimension: 0.0
 * /move_group/planner_configs/STRIDE/goal_bias: 0.05
 * /move_group/planner_configs/STRIDE/max_degree: 18
 * /move_group/planner_configs/STRIDE/max_pts_per_leaf: 6
 * /move_group/planner_configs/STRIDE/min_degree: 12
 * /move_group/planner_configs/STRIDE/min_valid_path_fraction: 0.2
 * /move_group/planner_configs/STRIDE/range: 0.0
 * /move_group/planner_configs/STRIDE/type: geometric::STRIDE
 * /move_group/planner_configs/STRIDE/use_projected_distance: 0
 * /move_group/planner_configs/TRRT/frountierNodeRatio: 0.1
 * /move_group/planner_configs/TRRT/frountier_threshold: 0.0
 * /move_group/planner_configs/TRRT/goal_bias: 0.05
 * /move_group/planner_configs/TRRT/init_temperature: 10e-6
 * /move_group/planner_configs/TRRT/k_constant: 0.0
 * /move_group/planner_configs/TRRT/max_states_failed: 10
 * /move_group/planner_configs/TRRT/min_temperature: 10e-10
 * /move_group/planner_configs/TRRT/range: 0.0
 * /move_group/planner_configs/TRRT/temp_change_factor: 2.0
 * /move_group/planner_configs/TRRT/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/sensors: [{'point_subsampl...
 * /move_group/start_state_max_bounds_error: 0.1
 * /move_group/trajectory_execution/allowed_execution_duration_scaling: 1.2
 * /move_group/trajectory_execution/allowed_goal_duration_margin: 0.5
 * /move_group/trajectory_execution/allowed_start_tolerance: 0.01
 * /robot_description: <?xml version="1....
 * /robot_description_kinematics/abb/kinematics_solver: kdl_kinematics_pl...
 * /robot_description_kinematics/abb/kinematics_solver_attempts: 3
 * /robot_description_kinematics/abb/kinematics_solver_search_resolution: 0.005
 * /robot_description_kinematics/abb/kinematics_solver_timeout: 0.005
 * /robot_description_kinematics/axis_abb/kinematics_solver: kdl_kinematics_pl...
QXcbConnection: Could not connect to display host.docker.internal:0.0
[rviz_743008dbe2c7_1_2235312150790565032-4] process has died [pid 76, exit code -6, cmd /opt/ros/kinetic/lib/rviz/rviz -d /root/catkin_ws/src/robotic_setups/src/abb_linear_axis_brick_moveit_config/launch/moveit.rviz __name:=rviz_743008dbe2c7_1_2235312150790565032 __log:=/root/.ros/log/db227882-2ede-11e9-afc3-0242c0a83002/rviz_743008dbe2c7_1_2235312150790565032-4.log].
log file: /root/.ros/log/db227882-2ede-11e9-afc3-0242c0a83002/rviz_743008dbe2c7_1_2235312150790565032-4*.log
 * /robot_description_kinematics/axis_abb/kinematics_solver_attempts:[ INFO] [1549987033.186822445]: Loading robot model 'abb_linear_axis_suction_tool'...
[ INFO] [1549987033.186898070]: No root/virtual joint specified in SRDF. Assuming fixed joint
[ INFO] [1549987033.375438225]: Loading robot model 'abb_linear_axis_suction_tool'...
[ INFO] [1549987033.375479344]: No root/virtual joint specified in SRDF. Assuming fixed joint
[ INFO] [1549987033.437545245]: Loading robot model 'abb_linear_axis_suction_tool'...
[ INFO] [1549987033.437590116]: No root/virtual joint specified in SRDF. Assuming fixed joint
[ INFO] [1549987033.731685777]: Publishing maintained planning scene on 'monitored_planning_scene'
[ INFO] [1549987033.737808882]: MoveGroup debug mode is ON
Starting context monitors...
[ INFO] [1549987033.737866291]: Starting scene monitor
[ INFO] [1549987033.745269227]: Listening to '/planning_scene'
[ INFO] [1549987033.745311522]: Starting world geometry monitor
[ INFO] [1549987033.752926068]: Listening to '/collision_object' using message notifier with target frame '/world '
[ INFO] [1549987033.760171229]: Listening to '/planning_scene_world' for planning scene world geometry
[ INFO] [1549987033.996069659]: Listening to '/head_mount_kinect/depth_registered/points' using message filter with target frame '/world '
[ INFO] [1549987034.013279309]: Listening to '/attached_collision_object' for attached collision objects
Context monitors started.
[ INFO] [1549987034.038544305]: Initializing OMPL interface using ROS parameters
[ INFO] [1549987034.144500129]: Using planning interface 'OMPL'
[ INFO] [1549987034.150813972]: Param 'default_workspace_bounds' was not set. Using default value: 10
[ INFO] [1549987034.153057453]: Param 'start_state_max_bounds_error' was set to 0.1
[ INFO] [1549987034.155225090]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1549987034.157127750]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1549987034.158692360]: Param 'jiggle_fraction' was set to 0.05
[ INFO] [1549987034.160141115]: Param 'max_sampling_attempts' was not set. Using default value: 100
[ INFO] [1549987034.160199874]: Using planning request adapter 'Add Time Parameterization'
[ INFO] [1549987034.160207917]: Using planning request adapter 'Fix Workspace Bounds'
[ INFO] [1549987034.160213599]: Using planning request adapter 'Fix Start State Bounds'
[ INFO] [1549987034.160218896]: Using planning request adapter 'Fix Start State In Collision'
[ INFO] [1549987034.160224180]: Using planning request adapter 'Fix Start State Path Constraints'
[ INFO] [1549987034.178850402]: Fake controller 'fake_axis_abb_controller' with joints [ axis_joint joint_1 joint_2 joint_3 joint_4 joint_5 joint_6 ]
[ INFO] [1549987034.180074651]: Fake controller 'fake_abb_controller' with joints [ joint_1 joint_2 joint_3 joint_4 joint_5 joint_6 ]
[ INFO] [1549987034.181328065]: Returned 2 controllers in list
[ INFO] [1549987034.219670083]: 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] [1549987034.400121078]: 

********************************************************
* MoveGroup using: 
*     - ApplyPlanningSceneService
*     - ClearOctomapService
*     - CartesianPathService
*     - ExecuteTrajectoryAction
*     - GetPlanningSceneService
*     - KinematicsService
*     - MoveAction
*     - PickPlaceAction
*     - MotionPlanService
*     - QueryPlannersService
*     - StateValidationService
********************************************************

[ INFO] [1549987034.400558251]: MoveGroup context using planning plugin ompl_interface/OMPLPlanner
[ INFO] [1549987034.400600444]: MoveGroup context initialization complete

You can start planning now!

source /Users/axydis/anaconda2/bin/activate
conda activate workshop
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

1 participant