trajectory_plan

ROS1 trajectory planner for the RX1 dual arm humanoid. This planner uses OMPL library and is able to take obstacle into consideration when planning trajectories. It is similar to MoveIt while it is way more light-weighted.

Dependencies

• Install RX1 ROS package
• Install OMPL:
  sudo apt-get install ros-noetic-ompl

Demo

1. Launch everything:
   roslaunch trajectory_planner trajectory_planner_with_gui.launch

2. Load the RQT GUI: click on "Plugins" in the rqt window and select "Trajectory planner rqt plugin". Then you should be able to see something like this:
   

3. Click and drag the Interactive Marker to determine the target pose of the left or right arm.
   
   note: Don't skip this step, try at least click on the marker. Also make sure the target is not too far and the orientation is achievable.

4. Click either "Plan Left Trajectory" or "Plan Right Trajectory" and wait until the planning succeeds.
   

5. Click either "Visualize Left Trajectory" or "Visualize Right Trajectory" to preview the trajectory.

6. Click either "Publish Left Trajectory" or "Publish Right Trajectory" to execute the trajectory.

7. Add obstacle by publishing a virtual cube.
   roslaunch cube_publisher cube_publisher.launch
   Plan trajectories again and you will see the planned trajectory avoiding the obstacle.