Removed the vicon check before sending cmd_vel. Chanegd waypoints to fly an outwards facing square