GUI can take vector inputs, but has trouble running through all waypoints.
changed layout so that plots are separate figures. changed jaw to toggle open/close
GUI can take vector input for desired location
allows for vector input of desire location, uncommented jaw control