Used for testing and debugging basic planning for atlas using moveit