Copter: inav circle initial implementation