Sim rviz for new beacon poses
level_two with dismount move
Merge remote-tracking branch 'origin/dumb_planner' into dumb_planner