added waypoints for arm PID- floor, bump, stash, hang