waypoints:
- point: {x: -0.555141, y: -0.439525, z: 0.00183678, vel: 1, rad: 0.8, stop: false}

finish_pose:
  header: {seq: 0, stamp: 226.652000000, frame_id: map}
  pose: 
    position: {x: -0.517291, y: 0.622856, z: 0}
    orientation: {x: 0, y: 0, z: 0.69261, w: 0.721313}