Commit Graph

228 Commits

Author SHA1 Message Date
Randy Mackay 9e156d2f81 Copter: always update current_loc regardless of inav state
If inertial nav is not initialised these will be set to zero anyway
2015-02-12 15:00:56 +09:00
Jonathan Challinger 2cb63dc792 Copter: don't assume home is at the origin 2015-02-03 11:38:25 +09:00
Randy Mackay cc52bbbffb Copter: update current loc once home is set 2015-01-22 14:39:59 +09:00
Randy Mackay 199dc3454d Copter: replace GPS_ok with position_ok
position_ok uses the EKF's filter status if the EKF is being used
otherwise it falls back to the GPS based checks used by inertial nav
2015-01-22 14:39:45 +09:00
Randy Mackay a4f71e5946 Copter: replace inav's position_ok with get_filter_status 2015-01-22 14:39:42 +09:00
Randy Mackay f54a13f24b Copter: report NAV_CONTROLLER_OUTPUT in RTL, Guided
This allows the GCS to display to the user where the vehicle is flying
to in RTL and Guided flight modes
2015-01-06 16:38:34 +09:00
Randy Mackay 817c893f21 Copter: bug fix for conditional_distance command
Due to a race condition, the wp_distance was not being updated before
the conditional_distance
2014-04-17 22:23:28 +09:00
Randy Mackay 359f1a27ec Copter: process cmds from mission lib 2014-03-19 12:10:11 +09:00
Randy Mackay 174318a2a9 Copter: remove set_nav_mode 2014-02-15 05:27:45 +11:00
Randy Mackay 1f07c2efe0 Copter: remove old circle 2014-02-15 05:27:41 +11:00
Randy Mackay d70862e44b Copter: remove case that does nothing 2014-02-15 05:27:37 +11:00
Randy Mackay dc6f622d48 Copter: move NTUN logging to 10hz loop 2014-02-15 05:27:36 +11:00
Randy Mackay 0a2adbac1b Copter: renaming functions after moving xy control 2014-02-15 05:27:36 +11:00
Randy Mackay 5fd9410ff5 Copter: much renaming as xy pos controller moves 2014-02-15 05:27:36 +11:00
Randy Mackay aaa62eeb28 Copter: integrated simpler init loiter from WP_Nav 2014-02-15 05:27:35 +11:00
Randy Mackay 8f5585423c Copter: use ahrs trig values 2014-02-08 18:16:49 +09:00
Randy Mackay a744658b47 Copter: combine nav_roll and control_roll
Control_roll, control_pitch now always hold the desired lean angle
whether it be from the pilot or autopilot.
2013-11-27 23:11:30 +09:00
Randy Mackay 03831cdd28 Copter: GPS ok only when not glitching
Removed redundant checks to GPS_ok before setting flight mode to RTL
(this check is already performed inside the set_mode function)
Removed reset of home distance and bearing when GPS lock is lost, it now
remains at the last known value
2013-11-11 22:24:18 +09:00
Jason Short 520a535c21 Copter: TOY mode updates 2013-11-02 21:34:48 +09:00
Randy Mackay 0c0de7c53e Copter: simple mode speedup
super simple and simple mode headings separated
g.super_simple converted into a bitmap by flight mode switch position
2013-10-05 18:26:56 +09:00
Randy Mackay b7579bb028 Copter: move init of global nav variables to set_nav_mode 2013-09-09 10:37:44 +09:00
Randy Mackay 45aeb1a921 Copter: split up loiter into 4 steps
Reduces disruption to the main loop but also introduces a delay of 30ms
to navigation output
2013-08-28 11:33:10 +09:00
Randy Mackay 05248738e2 Copter: bug fix for take-off in loiter 2013-07-28 18:18:43 +09:00
Randy Mackay c3daf78340 Copter: reset loiter target when landed 2013-07-28 18:18:41 +09:00
Randy Mackay 02b64e259d Copter: bug fix for descent during loiter_turns 2013-07-15 20:44:56 +09:00
Randy Mackay 345924ddec WPNav: replace LOITER_ACCEL_MAX with parameter
Also removed unused _lean_angle_max variable
2013-07-10 20:00:32 +09:00
Randy Mackay facd8fc89f Copter: calculate home position and bearing when we have 2D Fix 2013-06-25 22:23:26 +09:00
Olivier-ADLER f1bedc70ac Copter: SuperSimple mode bug
SuperSimple bearing was updated without checking for GPS 3D Fix availability.
2013-06-25 22:23:13 +09:00
Randy Mackay 272f0e5032 Copter: reduce twitch when entering CIRCLE mode
Set loiter target and prev iterations velocity when circle mode is
started
Start circling from projected stopping point
2013-06-15 18:18:30 +09:00
Randy Mackay 1b08f12d53 Circle: allow counter clockwise rotation 2013-06-03 22:12:56 +09:00
Randy Mackay 99f5462a03 Copter: circle mode fixes 2013-06-01 18:21:30 +09:00
Randy Mackay 4ad395e7be Copter: merge WPNAV into NTUN dataflash message 2013-05-19 22:53:35 +09:00
Randy Mackay 870b9b0fbb Copter: only run nav controllers when auto-armed
This stops run-up in target position and nav controller I terms ahead of
throttle being raised
2013-05-10 10:46:17 +09:00
Randy Mackay 74dca6da22 Copter: move update_commands to run_autopilot fn
update_commands was being run in the medium_loop counter but it is
easier to understand the flow of the code if it is consolidated along
with other autopilot calls.
2013-04-24 20:59:49 +09:00
Andrew Tridgell 5ad9deecfb Copter: cleanup some bit if tests to be clearer
Pair-Programmed-With: Randy Mackay <rmackay9@yahoo.com>
2013-04-23 23:03:34 +10:00
Andrew Tridgell 82c604dd67 Copter: more constrain fixes 2013-04-22 13:26:49 +10:00
Randy Mackay 37abfdc65a Copter: make CIRCLE_RATE a tunable parameter
Also bug fix to check of how many time it has rotated during a loiter
turns mission command
2013-04-20 12:03:55 +09:00
Randy Mackay 0b808abbed Copter: remove unused waypoint_valid function 2013-04-17 21:28:43 +09:00
Randy Mackay 8fe3e689f4 Copter: add WPNAV log message 2013-04-15 21:54:29 +09:00
Randy Mackay 629d23b7e2 Copter: remove WP_SPEED and WP_RADIUS parameters
AC_WPNav library has equivalent params with very similar names
2013-04-14 13:27:37 +09:00
Randy Mackay 700fb1b179 Copter: replace sin_yaw_y, cos_yaw_x in circle mode 2013-04-14 10:39:30 +09:00
Randy Mackay 1ee825ee9a Copter: move alt and wp checking to AC_WPNAV
RTL fix so that if it starts rtl-ing from above 80m it returns home
while descending instead of descending at initial position.
add get and set_target_alt_for_reporting
2013-04-14 10:39:23 +09:00
Randy Mackay a65960a009 Copter: use velocity based set_loiter_target 2013-04-14 10:38:28 +09:00
Randy Mackay 4de5f67a91 Copter: replace wp_nav.get_target_alt with get_destination_alt 2013-04-14 10:38:17 +09:00
Randy Mackay 5b93990e41 Copter: removed next_WP
Use the wp_nav.get_target_alt or controller_desired_alt in it's place
2013-04-14 10:38:07 +09:00
Randy Mackay 1516972eaa Copter: add panorama to CIRCLE mode
Yaw will slowly rotate if CIRCLE_RADIUS is set to zero
Circle center is projected forward CIRCLE_RADIUS from current position
and heading
2013-04-14 10:38:01 +09:00
Randy Mackay 58ed8cd544 Copter: replace set_next_WP with direct call to wp_nav 2013-04-14 10:37:55 +09:00
Randy Mackay 49828eba7d Copter: integrate AC_WPNav 2013-04-14 10:37:48 +09:00
Randy Mackay cdb532a594 Copter: bug fix for loiter target 2013-04-11 18:24:20 +09:00
Randy Mackay 95d944f610 Copter: Jason's bug fix for loiter's set_next_WP_latlon 2013-04-05 13:46:07 +09:00