Inverted yaw error back, fixed v4 code, cleaned up balloon_flight_test, think there's bugs in v4 still