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

Process[surfacing_application-5] has died! #166

Closed
GaoKui opened this issue Dec 21, 2018 · 21 comments
Closed

Process[surfacing_application-5] has died! #166

GaoKui opened this issue Dec 21, 2018 · 21 comments

Comments

@GaoKui
Copy link

GaoKui commented Dec 21, 2018

HELLO:
I tested it on Ubuntu 16.04, ROS-kinetic, PCL 1.8.0, VTK 7.1.1.
When I use GDB, it shows:

[WARN] [1545377664.210452821]: Bezier::keepUpperPartofDilatedMesh: Computing normals...
[ INFO] [1545377666.796006527]: BezierGrindingSurfacing::generateTrajectory: Generating grinding trajectories
[ INFO] [1545377666.817293583]: BezierGrindingSurfacing::generateTrajectory: Generating extrication trajectories
[ERROR] [1545377666.836747402]: BezierGrindingSurfacing::generateTrajectory: Extrication stripper has 2 lines

Thread 1 "bezier_applicat" received signal SIGSEGV, Segmentation fault.
0x000000000042a5c2 in _mm256_load_pd (__P=0x7fffffffbb10)
    at /usr/lib/gcc/x86_64-linux-gnu/5/include/avxintrin.h:836
836	  return *(__m256d *)__P;
(gdb) 
@GaoKui
Copy link
Author

GaoKui commented Dec 21, 2018

Thank you very much! @VictorLamoine

@VictorLamoine
Copy link
Contributor

The information you have provided is not enough.

Please provide a full backtrace, for that you need to compile in debug mode and produce a backtrace after the crash.

@GaoKui
Copy link
Author

GaoKui commented Dec 21, 2018

@VictorLamoine I compiled in debug mode, and this is the backtrace when I print bt in GDB mode:

Thread 1 "bezier_applicat" received signal SIGSEGV, Segmentation fault.
0x000000000042a5c2 in _mm256_load_pd (__P=0x7fffffffbbb0)
    at /usr/lib/gcc/x86_64-linux-gnu/5/include/avxintrin.h:836
836	  return *(__m256d *)__P;
(gdb) bt
#0  0x000000000042a5c2 in _mm256_load_pd (__P=0x7fffffffbbb0)
    at /usr/lib/gcc/x86_64-linux-gnu/5/include/avxintrin.h:836
#1  Eigen::internal::pload<double __vector(4)>(Eigen::internal::unpacket_traits<double __vector(4)>::type const*) (from=0x7fffffffbbb0)
    at /usr/include/eigen3/Eigen/src/Core/arch/AVX/PacketMath.h:207
#2  0x0000000000432f3e in Eigen::internal::ploadt<double __vector(4), 32>(Eigen::internal::unpacket_traits<double __vector(4)>::type const*) (
    from=0x7fffffffbbb0)
    at /usr/include/eigen3/Eigen/src/Core/GenericPacketMath.h:475
#3  Eigen::internal::evaluator<Eigen::PlainObjectBase<Eigen::Matrix<double, 4, 4, 0, 4, 4> > >::packet<32, double __vector(4)>(long, long) const (
    this=0x7fffffffba20, row=0, col=0)
    at /usr/include/eigen3/Eigen/src/Core/CoreEvaluators.h:183
#4  0x0000000000432d76 in Eigen::internal::generic_dense_assignment_kernel<Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::assign_op<double>, 0>::assignPacket<16, 32, double __vector(4)>(long, long) (
    this=0x7fffffffba30, row=0, col=0)
    at /usr/include/eigen3/Eigen/src/Core/AssignEvaluator.h:592
#5  0x0000000000432c9d in Eigen::internal::generic_dense_assignment_kernel<Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::assign_op<double>, 0>::assignPacketByOuterInner<16, 32, double __vector(4)>(long, long) (
---Type <return> to continue, or q <return> to quit---
    this=0x7fffffffba30, outer=0, inner=0)
    at /usr/include/eigen3/Eigen/src/Core/AssignEvaluator.h:606
#6  0x0000000000432a68 in Eigen::internal::copy_using_evaluator_innervec_CompleteUnrolling<Eigen::internal::generic_dense_assignment_kernel<Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::assign_op<double>, 0>, 0, 16>::run (kernel=...) at /usr/include/eigen3/Eigen/src/Core/AssignEvaluator.h:244
#7  0x00007ffff50bf686 in rviz_visual_tools::RvizVisualTools::publishCylinder(Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, std_msgs::ColorRGBA_<std::allocator<void> > const&, double, std::__cxx11::basic_string<char, std::char_traits<char>, std::allocator<char> > const&) ()
   from /opt/ros/kinetic/lib/librviz_visual_tools.so
#8  0x00007ffff50bfa1f in rviz_visual_tools::RvizVisualTools::publishCylinder(Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, rviz_visual_tools::colors, double, std::__cxx11::basic_string<char, std::char_traits<char>, std::allocator<char> > const&) ()
   from /opt/ros/kinetic/lib/librviz_visual_tools.so
#9  0x00007ffff50c06ac in rviz_visual_tools::RvizVisualTools::publishPath(std::vector<Eigen::Matrix<double, 3, 1, 0, 3, 1>, Eigen::aligned_allocator<Eigen::Matrix<double, 3, 1, 0, 3, 1> > > const&, rviz_visual_tools::colors, double, std::__cxx11::basic_string<char, std::char_traits<char>, std::allocator<char> > const&) () from /opt/ros/kinetic/lib/librviz_visual_tools.so
#10 0x00007ffff5d2a71f in Bezier::displayTrajectory (this=0x7242a0, 
---Type <return> to continue, or q <return> to quit---
    trajectory=std::vector of length 17, capacity 17 = {...}, 
    color=rviz_visual_tools::BLUE, display_normals=true, display_labels=false)
    at /home/walden/bezier_ws/src/bezier_library/src/bezier_library.cpp:151

#11 0x00007ffff7b9e281 in BezierGrindingSurfacing::generateTrajectory[abi:cxx11](std::vector<Eigen::Transform<double, 3, 2, 0>, Eigen::aligned_allocator<Eigen::Transform<double, 3, 2, 0> > >&, std::vector<bool, std::allocator<bool> >&, bool) (this=0x7242a0, trajectory=std::vector of length 0, capacity 0, 
    is_grinding_pose=std::vector<bool> of length 0, capacity 0, 
    display_markers=true)
    at /home/walden/bezier_ws/src/bezier_library/src/bezier_surfacing.cpp:441
#12 0x0000000000427c7f in main (argc=1, argv=0x7fffffffdb48)
    at /home/walden/bezier_ws/src/bezier_application/src/surfacing.cpp:105

@gavanderhoorn
Copy link
Member

gavanderhoorn commented Dec 21, 2018

@GaoKui: you'll want to press <return> a few times, as right now the backtrace only shows Eigen internals.


Edit: @GaoKui: thanks for the extended backtrace. Could you please:

  1. make sure to use proper formatting (see here)
  2. edit your previous comment in case you are improving or extending it?

@VictorLamoine
Copy link
Contributor

VictorLamoine commented Dec 21, 2018

So this is a case we do not handle in the library, when we extract lines from the mesh (by slicing it) we expect one and only one line to be produced.

This is not always the case (usually happens when the mesh has a hole).

You can find some comments here: https://github.com/ros-industrial-consortium/bezier/blob/kinetic-devel/bezier_library/src/bezier_surfacing.cpp#L154

I have merged a pull request that re-activates the commented error handling.

If you want to make this work you will have to handle this case, which means you have to dig into the code, understand it and add some functions to handle this case. The https://github.com/ros-industrial-consortium/bezier/tree/kinetic-devel/bezier_library/doc is a good place to start for understanding the algorithm.

@GaoKui
Copy link
Author

GaoKui commented Dec 21, 2018

@VictorLamoine Thank you for your reply. Actually I am a beginner for this, and I simply run

roslaunch bezier_application fanuc_m20ia_surfacing.launch surfacing_mode:=true mesh_cad:=plane/plane_defect.ply

It seems the plane mesh does not have any hole.

@GaoKui
Copy link
Author

GaoKui commented Dec 21, 2018

@gavanderhoorn I’m very sorry and I will pay attention to that in the future.Thanks for your help!

@VictorLamoine
Copy link
Contributor

I've just tested on Melodic and there is no crash. (I'm using the latest RViz visual tools version so #168 is necessary is order to be able to compile the package).

screenshot_20190102_105838

I get an error because of the outdated frame names and robot packages but the trajectory is correctly generated.

[ERROR] [1546422903.365594211]: TF Problem: Invalid argument "/base_link" passed to lookupTransform argument target_frame in tf2 frame_ids cannot start with a '/' like: 
[ERROR] [1546422903.365624364]: Error encountered transforming waypoints to frame 'base_link'
[ERROR] [1546422903.365772260]: Bezier application: A solution could not be found to move the robot along the trajectory, aborting.

@WuRobotics
Copy link

Hello Mr.Victor, @VictorLamoine

Hope you are doing well.
I'm stuck into this problem and hope to get your help, plz.

I'm trying to run the 'Bezier Example' project through the launch file in the link :
'fanuc_m10ia_surfacing.launch' and ''fanuc_m10ia_painting.launch ''.

Since the Bezier project is very precious learning material for me (almost the only one), I tried to use many different Ubuntu and ROS environments to test it.

The same issue appeared in every environment that I tested. Detailed info is shown below:

The environments that I tested
The project was compiled normally in all these environments below:

1. (On Vmware)
Ubuntu 16.04 with ROS kinetic, QT 5.1.1, VTK8.2.0 (shown in the 'bezier repo'), PCL 1.11.1(Latest version issue #12as )) ).

2. (On Laptop hardware+ Nvidia GTX1050)
Ubuntu 16.04 with ROS kinetic, QT 5.1.1, VTK8.2.0 (shown in the 'bezier repo'), PCL 1.11.1(Latest version issue #12 as )) ).

2. (On Vmware)
Ubuntu 18.04 with ROS Melodic, QT 5.1.1, VTK8.2.0 (shown in the 'bezier repo'), PCL 1.11.1(Latest version issue #12as )) ).

Firstly, the RVIZ interface showed up, the robot model and the mesh cad file showed up normally, like below:
image

And after for a while (about 5 seconds), the process was ended with an error like below:
image

During the normal period, I saw there were some warning that showed inside the RVIZ interface as below
(the yellow exclamation mark !):

Uninitialized quaternion, assuming identity.
scale.y and scale.z of LINE_LIST or LINE_STRIP are ignored.

I have carefully checked all the repos below but still not be able to solve this issue:

[https://github.com//issues/174](issue #174)
[https://github.com//issues/166](issue #166)
[https://github.com//pull/168](issue #168)
[https://github.com//issues/158](issue #158)
[https://github.com//issues/161](issue #161)

At your convenience, could you please spend some time helping me or give me some clue? It is really grateful!
Thanks again, and hope you have a nice day.
@GaoKui @VictorLamoine

@VictorLamoine
Copy link
Contributor

Can you debug the node with GDB please?
http://wiki.ros.org/roslaunch/Tutorials/Roslaunch%20Nodes%20in%20Valgrind%20or%20GDB

Don't forget to build the catkin workspace in debug mode!

catkin_make -DCMAKE_BUILD_TYPE=Debug

Please post the full gdb output here

@WuRobotics
Copy link

Hello Victor @VictorLamoine,

Really grateful for your reply.

  1. I tried to build the workspace in debug mode, it was compiled successfully.

  2. And then I debugged the node with GDB command launch-prefix="gdb -ex run --args"
    The Rviz automatically showed up as shown below (Some yellow ! showed in Rviz):
    image

Zooming in the mesh cad model:
image

The 'backtrace' is shown as below:

ansonwu18@ansonwu18-virtual-machine:~/catkin_workspace/devel$ roslaunch bezier_examples fanuc_m10ia_surfacing.launch surfacing_mode:=true mesh_cad:=plane/plane_defect.ply
... logging to /home/ansonwu18/.ros/log/d3a98790-0253-11eb-9fec-000c29f16db5/roslaunch-ansonwu18-virtual-machine-66562.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.

xacro: in-order processing became default in ROS Melodic. You can drop the option.
started roslaunch server http://ansonwu18-virtual-machine:36401/

SUMMARY
========

PARAMETERS
 * /controller_joint_names: ['joint_1', 'join...
 * /mesh_cad_param: plane/plane_defec...
 * /mesh_defect_param: 
 * /move_group/allow_trajectory_execution: True
 * /move_group/capabilities: 
 * /move_group/controller_list: [{'joints': ['joi...
 * /move_group/disable_capabilities: 
 * /move_group/generic_hw_control_loop/cycle_time_error_threshold: 0.01
 * /move_group/generic_hw_control_loop/loop_hz: 300
 * /move_group/hardware_interface/joints: ['joint_1', 'join...
 * /move_group/hardware_interface/sim_control_mode: 1
 * /move_group/jiggle_fraction: 0.05
 * /move_group/joint_state_controller/publish_rate: 50
 * /move_group/joint_state_controller/type: joint_state_contr...
 * /move_group/manipulator/default_planner_config: LBKPIECE
 * /move_group/manipulator/longest_valid_segment_fraction: 0.005
 * /move_group/manipulator/planner_configs: ['SBL', 'EST', 'L...
 * /move_group/manipulator/projection_evaluator: joints(joint_1,jo...
 * /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/moveit_sim_hw_interface/joint_model_group: controllers_initi...
 * /move_group/moveit_sim_hw_interface/joint_model_group_pose: controllers_initi...
 * /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/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/manipulator/kinematics_solver: kdl_kinematics_pl...
 * /robot_description_kinematics/manipulator/kinematics_solver_attempts: 3
 * /robot_description_kinematics/manipulator/kinematics_solver_search_resolution: 0.005
 * /robot_description_kinematics/manipulator/kinematics_solver_timeout: 0.005
 * /robot_description_planning/joint_limits/joint_1/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_1/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_1/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_1/max_velocity: 3.67
 * /robot_description_planning/joint_limits/joint_2/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_2/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_2/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_2/max_velocity: 3.32
 * /robot_description_planning/joint_limits/joint_3/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_3/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_3/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_3/max_velocity: 3.67
 * /robot_description_planning/joint_limits/joint_4/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_4/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_4/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_4/max_velocity: 6.98
 * /robot_description_planning/joint_limits/joint_5/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_5/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_5/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_5/max_velocity: 6.98
 * /robot_description_planning/joint_limits/joint_6/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_6/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_6/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_6/max_velocity: 10.47
 * /robot_description_semantic: <?xml version="1....
 * /rosdistro: melodic
 * /rosversion: 1.14.9
 * /surfacing_mode_param: True

NODES
  /
    bezier_examples_surfacing (bezier_examples/bezier_examples_surfacing)
    industrial_robot_simulator (industrial_robot_simulator/industrial_robot_simulator)
    joint_trajectory_action (industrial_robot_client/joint_trajectory_action)
    move_group (moveit_ros_move_group/move_group)
    robot_state_publisher (robot_state_publisher/robot_state_publisher)
    rviz (rviz/rviz)

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

setting /run_id to d3a98790-0253-11eb-9fec-000c29f16db5
process[rosout-1]: started with pid [66589]
started core service [/rosout]
process[industrial_robot_simulator-2]: started with pid [66596]
process[joint_trajectory_action-3]: started with pid [66597]
process[robot_state_publisher-4]: started with pid [66598]
process[move_group-5]: started with pid [66604]
process[bezier_examples_surfacing-6]: started with pid [66609]
process[rviz-7]: started with pid [66612]
[ INFO] [1601384463.428003676]: Loading robot model 'fanuc_m10ia'...
[ INFO] [1601384463.428824901]: No root/virtual joint specified in SRDF. Assuming fixed joint
GNU gdb (Ubuntu 8.1-0ubuntu3.2) 8.1.0.20180409-git
Copyright (C) 2018 Free Software Foundation, Inc.
License GPLv3+: GNU GPL version 3 or later <http://gnu.org/licenses/gpl.html>
This is free software: you are free to change and redistribute it.
There is NO WARRANTY, to the extent permitted by law.  Type "show copying"
and "show warranty" for details.
This GDB was configured as "x86_64-linux-gnu".
Type "show configuration" for configuration details.
For bug reporting instructions, please see:
<http://www.gnu.org/software/gdb/bugs/>.
Find the GDB manual and other documentation resources online at:
<http://www.gnu.org/software/gdb/documentation/>.
For help, type "help".
Type "apropos word" to search for commands related to "word"...
Reading symbols from /home/ansonwu18/catkin_workspace/devel/lib/bezier_examples/bezier_examples_surfacing...[ WARN] [1601384463.484940227]: Kinematics solver doesn't support #attempts anymore, but only a timeout.
Please remove the parameter '/robot_description_kinematics/manipulator/kinematics_solver_attempts' from your configuration.
done.
[ INFO] [1601384463.537474353]: Publishing maintained planning scene on 'monitored_planning_scene'
[ INFO] [1601384463.541152780]: MoveGroup debug mode is OFF
Starting planning scene monitors...
[ INFO] [1601384463.541185995]: Starting planning scene monitor
[ INFO] [1601384463.544199524]: Listening to '/planning_scene'
[ INFO] [1601384463.544271462]: Starting world geometry update monitor for collision objects, attached objects, octomap updates.
[ INFO] [1601384463.546600748]: Listening to '/collision_object'
[ INFO] [1601384463.549574449]: Listening to '/planning_scene_world' for planning scene world geometry
[ERROR] [1601384463.550384397]: Failed to find 3D sensor plugin parameters for octomap generation
[ INFO] [1601384463.555794639]: Listening to '/attached_collision_object' for attached collision objects
Planning scene monitors started.
[ INFO] [1601384463.583006375]: Initializing OMPL interface using ROS parameters
[ INFO] [1601384463.600423827]: Using planning interface 'OMPL'
[ INFO] [1601384463.603277472]: Param 'default_workspace_bounds' was not set. Using default value: 10
[ INFO] [1601384463.603620567]: Param 'start_state_max_bounds_error' was set to 0.1
[ INFO] [1601384463.603934729]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1601384463.604363581]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1601384463.604767129]: Param 'jiggle_fraction' was set to 0.05
[ INFO] [1601384463.605094709]: Param 'max_sampling_attempts' was not set. Using default value: 100
[ INFO] [1601384463.605163602]: Using planning request adapter 'Add Time Parameterization'
[ INFO] [1601384463.605195342]: Using planning request adapter 'Fix Workspace Bounds'
[ INFO] [1601384463.605215823]: Using planning request adapter 'Fix Start State Bounds'
[ INFO] [1601384463.605234005]: Using planning request adapter 'Fix Start State In Collision'
[ INFO] [1601384463.605271226]: Using planning request adapter 'Fix Start State Path Constraints'
[ERROR] [1601384463.611829949]: name, joints, action_ns, and type must be specifed for each controller
[ INFO] [1601384463.611963786]: Returned 0 controllers in list
[ INFO] [1601384463.622445415]: 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] [1601384463.672035335]: 

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

[ INFO] [1601384463.672122604]: MoveGroup context using planning plugin ompl_interface/OMPLPlanner
[ INFO] [1601384463.672157599]: MoveGroup context initialization complete

You can start planning now!

Starting program: /home/ansonwu18/catkin_workspace/devel/lib/bezier_examples/bezier_examples_surfacing __name:=bezier_examples_surfacing __log:=/home/ansonwu18/.ros/log/d3a98790-0253-11eb-9fec-000c29f16db5/bezier_examples_surfacing-6.log
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[Thread debugging using libthread_db enabled]
Using host libthread_db library "/lib/x86_64-linux-gnu/libthread_db.so.1".
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[New Thread 0x7fffca081700 (LWP 66680)]
[New Thread 0x7fffc9880700 (LWP 66681)]
[New Thread 0x7fffc907f700 (LWP 66682)]
[New Thread 0x7fffc887e700 (LWP 66683)]
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[ INFO] [1601384480.511125708]: CAD mesh file:plane/plane_defect.ply
[ INFO] [1601384480.511970260]: Bezier::Bezier: RViz visualization tool is initialized in 'base' and the topic name is 'rviz_visual_tools'
[ WARN] [1601384480.514332788]: Waiting for a subscriber on topic "/bezier_cad_mesh"
[ INFO] [1601384481.516277182]: Topic '/rviz_visual_tools' waiting for subscriber...
[ INFO] [1601384481.723447530]: BezierGrindingSurfacing::generateTrajectory: Dilating mesh
[ INFO] [1601384481.723618234]: Bezier::dilate: default parameters will be used to dilate the mesh
[New Thread 0x7fffbb9cf700 (LWP 66684)]
[New Thread 0x7fffbb1ce700 (LWP 66685)]
[New Thread 0x7fffba9cd700 (LWP 66686)]
[Thread 0x7fffbb9cf700 (LWP 66684) exited]
[Thread 0x7fffbb1ce700 (LWP 66685) exited]
[Thread 0x7fffba9cd700 (LWP 66686) exited]
[ WARN] [1601384482.149133084]: Bezier::keepUpperPartofDilatedMesh: Computing normals...
[ INFO] [1601384484.212996380]: BezierGrindingSurfacing::generateTrajectory: Generating grinding trajectories
[ INFO] [1601384484.228017902]: BezierGrindingSurfacing::generateTrajectory: Generating extrication trajectories
[ERROR] [1601384484.241687200]: BezierGrindingSurfacing::generateTrajectory: Extrication stripper has 2 lines

Thread 1 "bezier_examples" received signal SIGSEGV, Segmentation fault.
0x000055555557b58f in _mm256_load_pd (__P=0x7fffffffbfd0)
    at /usr/lib/gcc/x86_64-linux-gnu/7/include/avxintrin.h:862
862	  return *(__m256d *)__P;
(gdb) bt
#0  0x000055555557b58f in _mm256_load_pd (__P=0x7fffffffbfd0)
    at /usr/lib/gcc/x86_64-linux-gnu/7/include/avxintrin.h:862
#1  Eigen::internal::pload<double __vector(4)>(Eigen::internal::unpacket_traits<double __vector(4)>::type const*) (from=0x7fffffffbfd0)
    at /usr/include/eigen3/Eigen/src/Core/arch/AVX/PacketMath.h:214
#2  0x0000555555584070 in Eigen::internal::ploadt<double __vector(4), 32>(Eigen::internal::unpacket_traits<double __vector(4)>::type const*) (
    from=0x7fffffffbfd0)
    at /usr/include/eigen3/Eigen/src/Core/GenericPacketMath.h:463
#3  Eigen::internal::evaluator<Eigen::PlainObjectBase<Eigen::Matrix<double, 4, 4, 0, 4, 4> > >::packet<32, double __vector(4)>(long, long) const (
    this=0x7fffffffbe30, row=0, col=0)
    at /usr/include/eigen3/Eigen/src/Core/CoreEvaluators.h:197
#4  0x0000555555583e41 in Eigen::internal::generic_dense_assignment_kernel<Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::assign_op<double, double>, 0>::assignPacket<32, 32, double __vector(4)>(long, long) (
    this=0x7fffffffbe50, row=0, col=0)
    at /usr/include/eigen3/Eigen/src/Core/AssignEvaluator.h:652
#5  0x0000555555583c61 in Eigen::internal::generic_dense_assignment_kernel<Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::assign_op<double, double>, 0>::assignPacketByOuterInner<32, 32, double __vector(4)>(long, long---Type <return> to continue, or q <return> to quit---return
) (this=0x7fffffffbe50, outer=0, inner=0)
    at /usr/include/eigen3/Eigen/src/Core/AssignEvaluator.h:666
#6  0x0000555555583976 in Eigen::internal::copy_using_evaluator_innervec_CompleteUnrolling<Eigen::internal::generic_dense_assignment_kernel<Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::assign_op<double, double>, 0>, 0, 16>::run (kernel=...)
    at /usr/include/eigen3/Eigen/src/Core/AssignEvaluator.h:274
#7  0x00007ffff5007611 in rviz_visual_tools::RvizVisualTools::publishCylinder(Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, std_msgs::ColorRGBA_<std::allocator<void> > const&, double, std::__cxx11::basic_string<char, std::char_traits<char>, std::allocator<char> > const&) ()
   from /opt/ros/melodic/lib/librviz_visual_tools.so
#8  0x00007ffff50078bf in rviz_visual_tools::RvizVisualTools::publishCylinder(Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, rviz_visual_tools::colors, double, std::__cxx11::basic_string<char, std::char_traits<char>, std::allocator<char> > const&) ()
   from /opt/ros/melodic/lib/librviz_visual_tools.so
#9  0x00007ffff50084fb in rviz_visual_tools::RvizVisualTools::publishPath(std::vector<Eigen::Matrix<double, 3, 1, 0, 3, 1>, Eigen::aligned_allocator<Eigen::Matrix<double, 3, 1, 0, 3, 1> > > const&, rviz_visual_tools::colors, double, std::__cxx11::basic_string<char, std::char_traits<char>, std::allocator<char> > const&) () from /opt/ros/melodic/lib/librviz_visual_tools.so
---Type <return> to continue, or q <return> to quit---return
#10 0x00007ffff5ed9e99 in Bezier::displayTrajectory (this=0x555555cb2680, 
    trajectory=std::vector of length 17, capacity 17 = {...}, 
    color=rviz_visual_tools::BLUE, display_normals=true, display_labels=false)
    at /home/ansonwu18/catkin_workspace/src/bezier/src/bezier_library.cpp:153
#11 0x00007ffff7b99dc0 in BezierGrindingSurfacing::generateTrajectory[abi:cxx11](std::vector<Eigen::Transform<double, 3, 1, 0>, Eigen::aligned_allocator<Eigen::Transform<double, 3, 1, 0> > >&, std::vector<bool, std::allocator<bool> >&, bool) (this=0x555555cb2680, trajectory=std::vector of length 0, capacity 0, 
    is_grinding_pose=std::vector<bool> of length 0, capacity 0, 
    display_markers=true)
    at /home/ansonwu18/catkin_workspace/src/bezier/src/surfacing.cpp:441
#12 0x0000555555578909 in main (argc=1, argv=0x7fffffffdac8)
    at /home/ansonwu18/catkin_workspace/src/bezier_examples/bezier_examples/src/surfacing.cpp:104
(gdb) 

@WuRobotics
Copy link

For the 'Painting.launch' in the 'Bezier example', the main issues are almost the same as the 'Surfacing .launch'

After launching in the GDB mode, the Rviz interface showed up as well, but with only two 'yellow !', compared with the former surfacing project, the 'Marker' item seems working normal, which is shown below:

image

The backtrace of this 'Painting project' is shown below:

ansonwu18@ansonwu18-virtual-machine:~/catkin_workspace/devel$ roslaunch bezier_examples fanuc_m10ia_painting.launch mesh_cad:=ocean/ocean.ply
... logging to /home/ansonwu18/.ros/log/d36ac2f0-0256-11eb-9fec-000c29f16db5/roslaunch-ansonwu18-virtual-machine-67113.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.

xacro: in-order processing became default in ROS Melodic. You can drop the option.
started roslaunch server http://ansonwu18-virtual-machine:41599/

SUMMARY
========

PARAMETERS
 * /controller_joint_names: ['joint_1', 'join...
 * /mesh_cad_param: ocean/ocean.ply
 * /move_group/allow_trajectory_execution: True
 * /move_group/capabilities: 
 * /move_group/controller_list: [{'joints': ['joi...
 * /move_group/disable_capabilities: 
 * /move_group/generic_hw_control_loop/cycle_time_error_threshold: 0.01
 * /move_group/generic_hw_control_loop/loop_hz: 300
 * /move_group/hardware_interface/joints: ['joint_1', 'join...
 * /move_group/hardware_interface/sim_control_mode: 1
 * /move_group/jiggle_fraction: 0.05
 * /move_group/joint_state_controller/publish_rate: 50
 * /move_group/joint_state_controller/type: joint_state_contr...
 * /move_group/manipulator/default_planner_config: LBKPIECE
 * /move_group/manipulator/longest_valid_segment_fraction: 0.005
 * /move_group/manipulator/planner_configs: ['SBL', 'EST', 'L...
 * /move_group/manipulator/projection_evaluator: joints(joint_1,jo...
 * /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/moveit_sim_hw_interface/joint_model_group: controllers_initi...
 * /move_group/moveit_sim_hw_interface/joint_model_group_pose: controllers_initi...
 * /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/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/manipulator/kinematics_solver: kdl_kinematics_pl...
 * /robot_description_kinematics/manipulator/kinematics_solver_attempts: 3
 * /robot_description_kinematics/manipulator/kinematics_solver_search_resolution: 0.005
 * /robot_description_kinematics/manipulator/kinematics_solver_timeout: 0.005
 * /robot_description_planning/joint_limits/joint_1/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_1/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_1/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_1/max_velocity: 3.67
 * /robot_description_planning/joint_limits/joint_2/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_2/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_2/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_2/max_velocity: 3.32
 * /robot_description_planning/joint_limits/joint_3/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_3/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_3/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_3/max_velocity: 3.67
 * /robot_description_planning/joint_limits/joint_4/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_4/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_4/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_4/max_velocity: 6.98
 * /robot_description_planning/joint_limits/joint_5/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_5/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_5/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_5/max_velocity: 6.98
 * /robot_description_planning/joint_limits/joint_6/has_acceleration_limits: False
 * /robot_description_planning/joint_limits/joint_6/has_velocity_limits: True
 * /robot_description_planning/joint_limits/joint_6/max_acceleration: 0
 * /robot_description_planning/joint_limits/joint_6/max_velocity: 10.47
 * /robot_description_semantic: <?xml version="1....
 * /rosdistro: melodic
 * /rosversion: 1.14.9

NODES
  /
    bezier_examples_painting (bezier_examples/bezier_examples_painting)
    industrial_robot_simulator (industrial_robot_simulator/industrial_robot_simulator)
    joint_trajectory_action (industrial_robot_client/joint_trajectory_action)
    move_group (moveit_ros_move_group/move_group)
    robot_state_publisher (robot_state_publisher/robot_state_publisher)
    rviz (rviz/rviz)

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

setting /run_id to d36ac2f0-0256-11eb-9fec-000c29f16db5
process[rosout-1]: started with pid [67140]
started core service [/rosout]
process[industrial_robot_simulator-2]: started with pid [67147]
process[joint_trajectory_action-3]: started with pid [67148]
process[robot_state_publisher-4]: started with pid [67149]
process[move_group-5]: started with pid [67155]
process[bezier_examples_painting-6]: started with pid [67161]
process[rviz-7]: started with pid [67163]
[ INFO] [1601385751.532581548]: Loading robot model 'fanuc_m10ia'...
[ INFO] [1601385751.533380934]: No root/virtual joint specified in SRDF. Assuming fixed joint
GNU gdb (Ubuntu 8.1-0ubuntu3.2) 8.1.0.20180409-git
Copyright (C) 2018 Free Software Foundation, Inc.
License GPLv3+: GNU GPL version 3 or later <http://gnu.org/licenses/gpl.html>
This is free software: you are free to change and redistribute it.
There is NO WARRANTY, to the extent permitted by law.  Type "show copying"
and "show warranty" for details.
This GDB was configured as "x86_64-linux-gnu".
Type "show configuration" for configuration details.
For bug reporting instructions, please see:
<http://www.gnu.org/software/gdb/bugs/>.
Find the GDB manual and other documentation resources online at:
<http://www.gnu.org/software/gdb/documentation/>.
For help, type "help".
Type "apropos word" to search for commands related to "word"...
Reading symbols from /home/ansonwu18/catkin_workspace/devel/lib/bezier_examples/bezier_examples_painting...[ WARN] [1601385751.576500739]: Kinematics solver doesn't support #attempts anymore, but only a timeout.
Please remove the parameter '/robot_description_kinematics/manipulator/kinematics_solver_attempts' from your configuration.
[ INFO] [1601385751.632274120]: Publishing maintained planning scene on 'monitored_planning_scene'
[ INFO] [1601385751.633887301]: MoveGroup debug mode is OFF
Starting planning scene monitors...
[ INFO] [1601385751.634039084]: Starting planning scene monitor
[ INFO] [1601385751.635295324]: Listening to '/planning_scene'
[ INFO] [1601385751.635462336]: Starting world geometry update monitor for collision objects, attached objects, octomap updates.
[ INFO] [1601385751.636877259]: Listening to '/collision_object'
done.
[ INFO] [1601385751.638691872]: Listening to '/planning_scene_world' for planning scene world geometry
[ERROR] [1601385751.639583956]: Failed to find 3D sensor plugin parameters for octomap generation
[ INFO] [1601385751.649907664]: Listening to '/attached_collision_object' for attached collision objects
Planning scene monitors started.
[ INFO] [1601385751.681556752]: Initializing OMPL interface using ROS parameters
[ INFO] [1601385751.714168513]: Using planning interface 'OMPL'
[ INFO] [1601385751.717901844]: Param 'default_workspace_bounds' was not set. Using default value: 10
[ INFO] [1601385751.719011559]: Param 'start_state_max_bounds_error' was set to 0.1
[ INFO] [1601385751.719659293]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1601385751.720140091]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1601385751.720498750]: Param 'jiggle_fraction' was set to 0.05
[ INFO] [1601385751.720876574]: Param 'max_sampling_attempts' was not set. Using default value: 100
[ INFO] [1601385751.720977399]: Using planning request adapter 'Add Time Parameterization'
[ INFO] [1601385751.721100231]: Using planning request adapter 'Fix Workspace Bounds'
[ INFO] [1601385751.721165732]: Using planning request adapter 'Fix Start State Bounds'
[ INFO] [1601385751.721224816]: Using planning request adapter 'Fix Start State In Collision'
[ INFO] [1601385751.721282779]: Using planning request adapter 'Fix Start State Path Constraints'
[ERROR] [1601385751.726962795]: name, joints, action_ns, and type must be specifed for each controller
[ INFO] [1601385751.727082893]: Returned 0 controllers in list
[ INFO] [1601385751.740447832]: 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] [1601385751.794564319]: 

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

[ INFO] [1601385751.794649789]: MoveGroup context using planning plugin ompl_interface/OMPLPlanner
[ INFO] [1601385751.794675507]: MoveGroup context initialization complete

You can start planning now!

Starting program: /home/ansonwu18/catkin_workspace/devel/lib/bezier_examples/bezier_examples_painting __name:=bezier_examples_painting __log:=/home/ansonwu18/.ros/log/d36ac2f0-0256-11eb-9fec-000c29f16db5/bezier_examples_painting-6.log
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[Thread debugging using libthread_db enabled]
Using host libthread_db library "/lib/x86_64-linux-gnu/libthread_db.so.1".
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[New Thread 0x7fffca0ce700 (LWP 67232)]
[New Thread 0x7fffc98cd700 (LWP 67233)]
[New Thread 0x7fffc90cc700 (LWP 67234)]
[New Thread 0x7fffc88cb700 (LWP 67235)]
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[ INFO] [1601385769.319131366]: CAD mesh file:ocean/ocean.ply
[ INFO] [1601385769.321357235]: Bezier::Bezier: RViz visualization tool is initialized in 'base' and the topic name is 'rviz_visual_tools'
[ WARN] [1601385769.324650408]: Waiting for a subscriber on topic "/bezier_cad_mesh"
[ INFO] [1601385770.325741400]: Topic '/rviz_visual_tools' waiting for subscriber...

Thread 1 "bezier_examples" received signal SIGSEGV, Segmentation fault.
0x000055555557ffdf in _mm256_load_pd (__P=0x7fffffffc2b0) at /usr/lib/gcc/x86_64-linux-gnu/7/include/avxintrin.h:862
862	  return *(__m256d *)__P;
(gdb) bt
#0  0x000055555557ffdf in _mm256_load_pd (__P=0x7fffffffc2b0) at /usr/lib/gcc/x86_64-linux-gnu/7/include/avxintrin.h:862
#1  Eigen::internal::pload<double __vector(4)>(Eigen::internal::unpacket_traits<double __vector(4)>::type const*) (from=0x7fffffffc2b0)
    at /usr/include/eigen3/Eigen/src/Core/arch/AVX/PacketMath.h:214
#2  0x00005555555895ba in Eigen::internal::ploadt<double __vector(4), 32>(Eigen::internal::unpacket_traits<double __vector(4)>::type const*) (from=0x7fffffffc2b0)
    at /usr/include/eigen3/Eigen/src/Core/GenericPacketMath.h:463
#3  Eigen::internal::evaluator<Eigen::PlainObjectBase<Eigen::Matrix<double, 4, 4, 0, 4, 4> > >::packet<32, double __vector(4)>(long, long) const (this=0x7fffffffc110, 
    row=0, col=0) at /usr/include/eigen3/Eigen/src/Core/CoreEvaluators.h:197
#4  0x000055555558939b in Eigen::internal::generic_dense_assignment_kernel<Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::assign_op<double, double>, 0>::assignPacket<32, 32, double __vector(4)>(long, long) (this=0x7fffffffc130, 
    row=0, col=0) at /usr/include/eigen3/Eigen/src/Core/AssignEvaluator.h:652
#5  0x00005555555891ff in Eigen::internal::generic_dense_assignment_kernel<Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::assign_op<double, double>, 0>::assignPacketByOuterInner<32, 32, double __vector(4)>(long, long) (
    this=0x7fffffffc130, outer=0, inner=0) at /usr/include/eigen3/Eigen/src/Core/AssignEvaluator.h:666
#6  0x0000555555588eee in Eigen::internal::copy_using_evaluator_innervec_CompleteUnrolling<Eigen::internal::generic_dense_assignment_kernel<Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::assign_op<double, double>, 0>, 0, 16>::run (
    kernel=...) at /usr/include/eigen3/Eigen/src/Core/AssignEvaluator.h:274
#7  0x00007ffff4e51611 in rviz_visual_tools::RvizVisualTools::publishCylinder(Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, std_msgs::ColorRGBA_<std::allocator<void> > const&, double, std::__cxx11::basic_string<char, std::char_traits<char>, std::allocator<char> > const&) ()
   from /opt/ros/melodic/lib/librviz_visual_tools.so
#8  0x00007ffff4e518bf in rviz_visual_tools::RvizVisualTools::publishCylinder(Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, rviz_visual_tools::colors, double, std::__cxx11::basic_string<char, std::char_traits<char>, std::allocator<char> > const&) ()
   from /opt/ros/melodic/lib/librviz_visual_tools.so
#9  0x00007ffff4e524fb in rviz_visual_tools::RvizVisualTools::publishPath(std::vector<Eigen::Matrix<double, 3, 1, 0, 3, 1>, Eigen::aligned_allocator<Eigen::Matrix<double, 3, 1, 0, 3, 1> > > const&, rviz_visual_tools::colors, double, std::__cxx11::basic_string<char, std::char_traits<char>, std::allocator<char> > const&) ()
   from /opt/ros/melodic/lib/librviz_visual_tools.so
#10 0x00007ffff5d23e99 in Bezier::displayTrajectory (this=0x555555cbb640, trajectory=std::vector of length 50, capacity 50 = {...}, color=rviz_visual_tools::BLUE, 
    display_normals=true, display_labels=false) at /home/ansonwu18/catkin_workspace/src/bezier/src/bezier_library.cpp:153
#11 0x00007ffff7bb389a in BezierPainting::generateTrajectory[abi:cxx11](std::vector<Eigen::Transform<double, 3, 1, 0>, Eigen::aligned_allocator<Eigen::Transform<double, 3, 1, 0> > >&, std::vector<bool, std::allocator<bool> >&, bool) (this=0x555555cbb640, trajectory=std::vector of length 1055, capacity 2048 = {...}, 
    is_grinding_pose=std::vector<bool> of length 1056, capacity 2048 = {...}, display_markers=true) at /home/ansonwu18/catkin_workspace/src/bezier/src/painting.cpp:152
#12 0x000055555557d394 in main (argc=1, argv=0x7fffffffdac8) at /home/ansonwu18/catkin_workspace/src/bezier_examples/bezier_examples/src/painting.cpp:94
(gdb) 

@WuRobotics
Copy link

Thanks again @VictorLamoine , really grateful for your help, merci.

@VictorLamoine
Copy link
Contributor

Thanks for the backtrace. Looks like this bug is https://eigen.tuxfamily.org/bz/show_bug.cgi?id=1427

What Eigen version are you using?

dpkg -l *eigen*

@WuRobotics
Copy link

Hello Victor @VictorLamoine

The Eigen version is 3.3.4-4 as in the screenshot below;
By the way, the backtrace is from the ROS Melodic in Ubuntu 18.04:

image

Thanks again, Victor.

@VictorLamoine
Copy link
Contributor

Install the latest version (http://eigen.tuxfamily.org/index.php?title=Main_Page) and configure CMake to use this new version.
Compile and test again, it should solve the problem as this seems to be an Eigen problem.

@WuRobotics
Copy link

Install the latest version (http://eigen.tuxfamily.org/index.php?title=Main_Page) and configure CMake to use this new version.
Compile and test again, it should solve the problem as this seems to be an Eigen problem.

Hello Victor,

Thanks for your reply, I will try to do in this way and give you the feedback soon.
Really thanks for your help.

@WuRobotics
Copy link

Hello Victor @VictorLamoine

I uninstalled the old version Eigen (3.3.4-4) and installed the latest version Eigen (3.3.7).
And recompiled the workspace by using the latest Eigen, compile successfully.

Unfortunately the crash issue still exists...
But the good news is that the backtrace is not the same as the former one:
I tried to search the reason for the crash on google and nearly all the forums, but still get no luck..

Could you please help me to check the backtrace below?
Really thanks for your help and time.

setting /run_id to e8627b86-0408-11eb-93c0-000c29f16db5
process[rosout-1]: started with pid [14408]
started core service [/rosout]
process[industrial_robot_simulator-2]: started with pid [14415]
process[joint_trajectory_action-3]: started with pid [14416]
process[robot_state_publisher-4]: started with pid [14417]
process[move_group-5]: started with pid [14423]
process[bezier_examples_surfacing-6]: started with pid [14429]
process[rviz-7]: started with pid [14432]
[ INFO] [1601572188.316673267]: Loading robot model 'fanuc_m10ia'...
[ INFO] [1601572188.317210896]: No root/virtual joint specified in SRDF. Assuming fixed joint
GNU gdb (Ubuntu 8.1-0ubuntu3.2) 8.1.0.20180409-git
Copyright (C) 2018 Free Software Foundation, Inc.
License GPLv3+: GNU GPL version 3 or later <http://gnu.org/licenses/gpl.html>
This is free software: you are free to change and redistribute it.
There is NO WARRANTY, to the extent permitted by law.  Type "show copying"
and "show warranty" for details.
This GDB was configured as "x86_64-linux-gnu".
Type "show configuration" for configuration details.
For bug reporting instructions, please see:
<http://www.gnu.org/software/gdb/bugs/>.
Find the GDB manual and other documentation resources online at:
<http://www.gnu.org/software/gdb/documentation/>.
For help, type "help".
Type "apropos word" to search for commands related to "word"...
Reading symbols from /home/ansonwu18/catkin_workspace/devel/lib/bezier_examples/bezier_examples_surfacing...(no debugging symbols found)...done.
Starting program: /home/ansonwu18/catkin_workspace/devel/lib/bezier_examples/bezier_examples_surfacing __name:=bezier_examples_surfacing __log:=/home/ansonwu18/.ros/log/e8627b86-0408-11eb-93c0-000c29f16db5/bezier_examples_surfacing-6.log
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[ WARN] [1601572188.355995849]: Kinematics solver doesn't support #attempts anymore, but only a timeout.
Please remove the parameter '/robot_description_kinematics/manipulator/kinematics_solver_attempts' from your configuration.
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[ INFO] [1601572188.392782372]: Publishing maintained planning scene on 'monitored_planning_scene'
[ INFO] [1601572188.394462228]: MoveGroup debug mode is OFF
Starting planning scene monitors...
[ INFO] [1601572188.394490565]: Starting planning scene monitor
[ INFO] [1601572188.395809804]: Listening to '/planning_scene'
[ INFO] [1601572188.395850965]: Starting world geometry update monitor for collision objects, attached objects, octomap updates.
[ INFO] [1601572188.397132669]: Listening to '/collision_object'
[ INFO] [1601572188.398824393]: Listening to '/planning_scene_world' for planning scene world geometry
[ERROR] [1601572188.399395747]: Failed to find 3D sensor plugin parameters for octomap generation
[ INFO] [1601572188.405607297]: Listening to '/attached_collision_object' for attached collision objects
Planning scene monitors started.
[ INFO] [1601572188.423867820]: Initializing OMPL interface using ROS parameters
[ INFO] [1601572188.442083848]: Using planning interface 'OMPL'
[ INFO] [1601572188.444474398]: Param 'default_workspace_bounds' was not set. Using default value: 10
[ INFO] [1601572188.445061105]: Param 'start_state_max_bounds_error' was set to 0.1
[ INFO] [1601572188.445603880]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1601572188.446068123]: Param 'start_state_max_dt' was not set. Using default value: 0.5
[ INFO] [1601572188.446562185]: Param 'jiggle_fraction' was set to 0.05
[ INFO] [1601572188.447006328]: Param 'max_sampling_attempts' was not set. Using default value: 100
[ INFO] [1601572188.447080861]: Using planning request adapter 'Add Time Parameterization'
[ INFO] [1601572188.447135041]: Using planning request adapter 'Fix Workspace Bounds'
[ INFO] [1601572188.447178956]: Using planning request adapter 'Fix Start State Bounds'
[ INFO] [1601572188.447222009]: Using planning request adapter 'Fix Start State In Collision'
[ INFO] [1601572188.447265255]: Using planning request adapter 'Fix Start State Path Constraints'
[ERROR] [1601572188.451749939]: name, joints, action_ns, and type must be specifed for each controller
[ INFO] [1601572188.451859289]: Returned 0 controllers in list
[ INFO] [1601572188.459242120]: 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] [1601572188.508781185]: 

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

[ INFO] [1601572188.508883411]: MoveGroup context using planning plugin ompl_interface/OMPLPlanner
[ INFO] [1601572188.508940107]: MoveGroup context initialization complete

You can start planning now!

[Thread debugging using libthread_db enabled]
Using host libthread_db library "/lib/x86_64-linux-gnu/libthread_db.so.1".
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[New Thread 0x7fffca084700 (LWP 14490)]
[New Thread 0x7fffc9883700 (LWP 14491)]
[New Thread 0x7fffc9082700 (LWP 14492)]
[New Thread 0x7fffc8881700 (LWP 14493)]
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[ INFO] [1601572204.236067058]: CAD mesh file:plane/plane.ply
[ INFO] [1601572204.236899915]: Bezier::Bezier: RViz visualization tool is initialized in 'base' and the topic name is 'rviz_visual_tools'
[ WARN] [1601572204.239611585]: Waiting for a subscriber on topic "/bezier_cad_mesh"
[ INFO] [1601572205.241688058]: Topic '/rviz_visual_tools' waiting for subscriber...
[ INFO] [1601572205.519968112]: BezierGrindingSurfacing::generateTrajectory: Dilating mesh
[ INFO] [1601572205.520280097]: Bezier::dilate: default parameters will be used to dilate the mesh
[New Thread 0x7fffbb9cf700 (LWP 14494)]
[New Thread 0x7fffbb1ce700 (LWP 14495)]
[New Thread 0x7fffba9cd700 (LWP 14496)]
[Thread 0x7fffbb1ce700 (LWP 14495) exited]
[Thread 0x7fffbb9cf700 (LWP 14494) exited]
[Thread 0x7fffba9cd700 (LWP 14496) exited]
[ WARN] [1601572205.678835577]: Bezier::keepUpperPartofDilatedMesh: Computing normals...
[ INFO] [1601572207.698613764]: BezierGrindingSurfacing::generateTrajectory: Generating grinding trajectories
[ INFO] [1601572207.726374599]: BezierGrindingSurfacing::generateTrajectory: Generating extrication trajectories

Thread 1 "bezier_examples" received signal SIGSEGV, Segmentation fault.
0x000055555557b58f in double __vector(4) Eigen::internal::pload<double __vector(4)>(Eigen::internal::unpacket_traits<double __vector(4)>::type const*) ()
(gdb) bt
#0  0x000055555557b58f in double __vector(4) Eigen::internal::pload<double __vector(4)>(Eigen::internal::unpacket_traits<double __vector(4)>::type const*) ()
#1  0x0000555555584036 in double __vector(4) Eigen::internal::evaluator<Eigen::PlainObjectBase<Eigen::Matrix<double, 4, 4, 0, 4, 4> > >::packet<32, double __vector(4)>(long, long) const ()
#2  0x0000555555583e07 in void Eigen::internal::generic_dense_assignment_kernel<Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::assign_op<double, double>, 0>::assignPacket<32, 32, double __vector(4)>(long, long) ()
#3  0x0000555555583c03 in void Eigen::internal::generic_dense_assignment_kernel<Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::assign_op<double, double>, 0>::assignPacketByOuterInner<32, 32, double __vector(4)>(long, long) ()
#4  0x0000555555583918 in Eigen::internal::copy_using_evaluator_innervec_CompleteUnrolling<Eigen::internal::generic_dense_assignment_kernel<Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::assign_op<double, double>, 0>, 0, 16>::run(Eigen::internal::generic_dense_assignment_kernel<Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::evaluator<Eigen::Matrix<double, 4, 4, 0, 4, 4> >, Eigen::internal::assign_op<double, double>, 0>&) ()
#5  0x00007ffff500a611 in rviz_visual_tools::RvizVisualTools::publishCylinder(Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, std_msgs::ColorRGBA_<std::allocator<void> > const&, double, std::__cxx11---Type <return> to continue, or q <return> to quit---return
::basic_string<char, std::char_traits<char>, std::allocator<char> > const&) ()
   from /opt/ros/melodic/lib/librviz_visual_tools.so
#6  0x00007ffff500a8bf in rviz_visual_tools::RvizVisualTools::publishCylinder(Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, Eigen::Matrix<double, 3, 1, 0, 3, 1> const&, rviz_visual_tools::colors, double, std::__cxx11::basic_string<char, std::char_traits<char>, std::allocator<char> > const&) ()
   from /opt/ros/melodic/lib/librviz_visual_tools.so
#7  0x00007ffff500b4fb in rviz_visual_tools::RvizVisualTools::publishPath(std::vector<Eigen::Matrix<double, 3, 1, 0, 3, 1>, Eigen::aligned_allocator<Eigen::Matrix<double, 3, 1, 0, 3, 1> > > const&, rviz_visual_tools::colors, double, std::__cxx11::basic_string<char, std::char_traits<char>, std::allocator<char> > const&) () from /opt/ros/melodic/lib/librviz_visual_tools.so
#8  0x00007ffff5edbbf9 in Bezier::displayTrajectory(std::vector<Eigen::Transform<double, 3, 1, 0>, Eigen::aligned_allocator<Eigen::Transform<double, 3, 1, 0> > > const&, rviz_visual_tools::colors, bool, bool) ()
   from /home/ansonwu18/catkin_workspace/devel/lib/libbezier.so
#9  0x00007ffff7b9a2e0 in BezierGrindingSurfacing::generateTrajectory[abi:cxx11](std::vector<Eigen::Transform<double, 3, 1, 0>, Eigen::aligned_allocator<Eigen::Transform<double, 3, 1, 0> > >&, std::vector<bool, std::allocator<bool> >&, bool) () from /home/ansonwu18/catkin_workspace/devel/lib/libbezier_surfacing.so
#10 0x0000555555578909 in main ()
(gdb) 

@VictorLamoine
Copy link
Contributor

VictorLamoine commented Oct 2, 2020

You didn't need to uninstall the Eigen 3.3.4-4 but anyway, the problem lies in rviz_visual_tools (publishCylinder method), not in bezier.

Are you using the source version of rviz_visual_tools or the released package?
If you are using the released package clone https://github.com/PickNikRobotics/rviz_visual_tools in your catkin workspace and try again.

@WuRobotics
Copy link

Hello Victor @VictorLamoine

Thanks for your reply and help.
In the former test, the source version of the rviz_visual_tools was used.

Today, I cloned the released package from the GitHub link https://github.com/PickNikRobotics/rviz_visual_tools
and recompiled the workspace successfully.

The issue of rviz_visual_tools seems fixed, but the process died issue is still existed.
The latest backtrace is shown below, 5 items left. Maybe the issues are related to VTK and PCL libraries.

Thanks again for your help and time.

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

[ INFO] [1601684652.811018251]: MoveGroup context using planning plugin ompl_interface/OMPLPlanner
[ INFO] [1601684652.811046290]: MoveGroup context initialization complete

You can start planning now!

[Thread debugging using libthread_db enabled]
Using host libthread_db library "/lib/x86_64-linux-gnu/libthread_db.so.1".

[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[New Thread 0x7fff9fd21700 (LWP 24393)]
[New Thread 0x7fff9f520700 (LWP 24394)]
[New Thread 0x7fff9ed1f700 (LWP 24395)]
[New Thread 0x7fff9e51e700 (LWP 24396)]
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[tcsetpgrp failed in terminal_inferior: Inappropriate ioctl for device]
[ INFO] [1601684675.440831557]: CAD mesh file:plane/plane_defect.ply
[ INFO] [1601684675.442097565]: Bezier::Bezier: RViz visualization tool is initialized in 'base' and the topic name is 'rviz_visual_tools'
[ WARN] [1601684675.445440537]: Waiting for a subscriber on topic "/bezier_cad_mesh"
[ INFO] [1601684676.449576618]: Topic '/rviz_visual_tools' waiting for subscriber...

Thread 1 "bezier_examples" received signal SIGSEGV, Segmentation fault.
0x00007fffecca93ba in vtkPointSet::SetPoints(vtkPoints*) [clone .localalias.36]
    () from /usr/local/lib/libvtkCommonDataModel-8.2.so.1
(gdb) 
(gdb) bt
#0  0x00007fffecca93ba in vtkPointSet::SetPoints(vtkPoints*) [clone .localalias.36] () 
   from /usr/local/lib/libvtkCommonDataModel-8.2.so.1
#1  0x00007ffff0ad76b9 in pcl::VTKUtils::vtk2mesh(vtkSmartPointer<vtkPolyData> const&, pcl::PolygonMesh&) ()
   from /usr/lib/x86_64-linux-gnu/libpcl_surface.so.1.8
#2  0x00007fffcba8c178 in Bezier::estimateGlobalMeshNormal(vtkSmartPointer<vtkPolyData>&, Eigen::Matrix<double, 3, 1, 0, 3, 1>&, unsigned int) ()
   from /home/ansonwu18/catkin_workspace/build/devel/lib/libbezier.so
#3  0x00007fffcba8cb79 in Bezier::estimateSlicingOrientation(vtkSmartPointer<vtkPolyData>&, Eigen::Matrix<double, 3, 1, 0, 3, 1>&, Eigen::Matrix<double, 3, 1, 0, 3, 1>&) () from /home/ansonwu18/catkin_workspace/build/devel/lib/libbezier.so
#4  0x00007ffff772b923 in BezierGrindingSurfacing::generateTrajectory[abi:cxx11](std::vector<Eigen::Transform<double, 3, 1, 0>, Eigen::aligned_allocator<Eigen::Transform<double, 3, 1, 0> > >&, std::vector<bool, std::allocator<bool> >&, bool) ()
   from /home/ansonwu18/catkin_workspace/build/devel/lib/libbezier_surfacing.so
#5  0x0000000000428d66 in main ()
(gdb) 

@VictorLamoine
Copy link
Contributor

Now the problem lies in the PCL pcl::VTKUtils::vtk2mesh function. Build PCL in debug mode and try to determine what is making it crash

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

4 participants