Successful flight without Vicon at all. Uses basic PD controller and back and forth waypoints