Motion planning of robot in RViz using MoveIt! configuration package

MoveIt! provides a plugin for RViz which allows it to create new planning scenes where robot works, generate motion plans, add new objects, visualize the planning output and can directly interact with the visualized robot.

The MoveIt! configuration package consists of configuration files and launch files to start motion planning in RViz. There is a demo launch file in the package to explore all the functionalities of this package.

Following is the command to invoke the demo launch file:

$ roslaunch seven_dof_arm_config demo.launch

If everything works fine, we will get the following screen of RViz being loaded with the MotionPlanning plugin provided by MoveIt!:

Figure 11 : MoveIt! - RViz motion planning interface

Using the RViz MotionPlanning plugin

From the preceding Figure 11, we can see that the RViz-Motion Planning plugin is loaded on the left side of the screen. There are several tabs on the Motion Planning window, such...