Motion planning of robot in RViz using MoveIt! configuration package