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