Copter: remove unused NAV_WP_INAV #define
Math: add wrap_PI
Copter Nav: add accessor for waypoint speed
Copter: remove debug message
Copter: circle mode fixes
Autotest: update randy's sim script
AutoTest: add circle mode test