Randy Mackay
98bdbb7fed
AC_WPNav: set loiter accel to 1/2 of speed
...
Bug fix from Leonard.
Also fixed some formatting.
2014-02-20 21:37:45 +09:00
Andrew Tridgell
f222f2ef1e
DataFlash: fixed logging on PX4v1
...
large writes break IO, a NuttX bug
2014-02-20 06:55:35 +11:00
Andrew Tridgell
20b0444c15
AP_NavEKF: remove sleep on init of EKF
...
this prevents HIL from locking up, and also prevents a possible 1s
delay in flight on EKF init
2014-02-19 22:04:12 +11:00
Andrew Tridgell
b434c11215
AP_AHRS: removed empty file
2014-02-19 22:00:25 +11:00
Randy Mackay
aa5ea23245
GCS_MAVLink: regenerate for COMPASSMOT_STATUS msg
2014-02-19 16:04:08 +11:00
Randy Mackay
a7c25ec649
GCS_MALink: improved generate.sh failure msg
2014-02-19 16:04:05 +11:00
Andrew Tridgell
50cbc661ef
GCS_MAVLink: added new COMPASSMOT_STATUS message
2014-02-19 16:03:57 +11:00
Andrew Tridgell
c9d0c1face
AP_NavEKF: use ahrs->get_armed() for static mode demanded
2014-02-19 10:52:57 +11:00
Andrew Tridgell
3b1f9a4bbf
AP_AHRS: added get_armed() and set_armed() calls
...
will be used by NavEKF to determine static mode
2014-02-19 10:52:24 +11:00
Andrew Tridgell
fe0cb23733
AP_InertialSensor: fixed HIL for 400Hz INS
2014-02-19 10:29:00 +11:00
Andrew Tridgell
536160a3fb
AP_NavEKF: use AHRS get_correct_centrifugal()
2014-02-19 10:28:45 +11:00
Andrew Tridgell
fad0b2b233
AP_AHRS: added get_correct_centrifugal()
...
used by NavEKF to force static mode
2014-02-19 10:28:14 +11:00
Andrew Tridgell
599c3a8abf
AP_Math: added more operators to VectorN
2014-02-19 10:14:58 +11:00
Andrew Tridgell
869e41fd03
AP_NavEKF: fixed detection of airspeed sensor
...
the get_airspeed() AHRS call can change as the user enables/disables
the airspeed sensor, plus it only gets enabled after the NavEKF
constructor runs.
2014-02-19 09:22:45 +11:00
Paul Riseborough
1ade39977a
AP_NavEKF : covariance prediction cleanup
2014-02-19 09:22:45 +11:00
Paul Riseborough
8daca145d0
AP_NavEKF : useAirspeed set automatically
2014-02-19 09:22:45 +11:00
Paul Riseborough
6fbada26d3
AP_NavEKF : Improvements to staticMode robustness
2014-02-19 09:22:45 +11:00
Mike McCauley
bd768a0c0c
AP_HAL_FLYMAPLE RCOutput.cpp: enable_ch no longer resets servo
...
FLYMAPLERCOutput::enable_ch incorrectly reset the servo to 0, which caused
servo twitching once per second when RC_Channel_aux::enable_aux_servos
enabled each channel.
2014-02-18 09:25:08 +11:00
Andrew Tridgell
ad4db4de6c
AP_Airspeed: added setHIL() method
...
useful for log playback
2014-02-18 09:25:08 +11:00
Andrew Tridgell
e11ada7bf0
RC_Channel: fixed comment on enable_aux_servos()
...
thanks to Mike McCauley for spotting
2014-02-18 09:25:07 +11:00
Andrew Tridgell
b2bd81f262
AP_Baro: added alternative setHIL interface
...
uses pressure and temperature for better log replay
2014-02-18 09:25:07 +11:00
Andrew Tridgell
5bf170c440
AP_NavEKF: fixed log replay code
...
also added BARO and ARSP messages
2014-02-18 09:25:07 +11:00
jschall
024855014f
AC_PosControl: update _pos_error if it is being limited
...
This fixes a bug that causes 10hz throttle noise.
2014-02-17 22:33:06 +09:00
Andrew Tridgell
9cf70fe3f7
AP_HAL: another broken example build
...
this one an internal compiler error
2014-02-17 12:42:13 +11:00
Mike McCauley
4f9f87a8c6
AP_HAL_FLYMAPLE: Add notes to FlymaplePortingNotes.txt re GPS selection.
2014-02-17 05:56:37 +11:00
Mike McCauley
54a0b04c12
AP_HAL_FLYMAPLE: RCInput detects stale input readings better. Update test
...
code.
2014-02-17 05:56:37 +11:00
Mike McCauley
f1533aa350
AP_HAL_FLYAPLE: update documentation in FlymaplePortingNotes.txt
2014-02-17 05:56:37 +11:00
Mike McCauley
81791bdc43
AP_HAL_FLYMAPLE: Added documentation about alternative orientations to FlymaplePortingNotes.txt
2014-02-17 05:56:37 +11:00
Mike McCauley
95bea052d2
AP_HAL_FLYMAPLE: update documentation in FlymaplePortingNotes.txt
2014-02-17 05:56:37 +11:00
Mike McCauley
2c94a40310
AP_InertialSensor: AP_InertialSensor_Flymaple Remove unnecessary
...
comment
2014-02-17 05:56:37 +11:00
Mike McCauley
dd6abb49a9
AP_InertialSensor: AP_InertialSensor_Flymaple::healthy() was required after
...
all.
2014-02-17 05:56:37 +11:00
Mike McCauley
0a43cf8c5c
AP_InertialSensor: AP_InertialSensor_Flymaple removed redundant definition of
...
healthy().
2014-02-17 05:56:37 +11:00
Mike McCauley
f7279aa13f
AP_InertialSensor: AP_InertialSensor_Flymaple implement get_gyro_health
...
and get_accel_health.
2014-02-17 05:56:37 +11:00
Mike McCauley
4dc33c8de8
AP_HAL_FLYMAPLE: updated FlymaplePortingNotes.txt
2014-02-17 05:56:37 +11:00
Randy Mackay
d277b6cabd
AC_AttControl: fix @Units parameter descriptions
2014-02-16 22:36:59 +09:00
Paul Riseborough
7a82746fcc
AP_NavEKF : fixed bug in pos and vel reset when in static mode
2014-02-16 22:35:19 +11:00
Paul Riseborough
275ef86f86
AP_NavEKF : Position and Velocity reset bugfix
2014-02-16 21:05:37 +11:00
Paul Riseborough
b22dc706b2
AP_NavEKF : staticMode bugfix and robustness improvements
2014-02-16 21:04:55 +11:00
Paul Riseborough
2926602718
AP_NavEKF : Cleaned up InitialiseFilterDynamic
2014-02-16 21:04:51 +11:00
Paul Riseborough
404fbafe26
AP_NavEKF : Changed timout behaviour to only reset PosVel states
2014-02-16 21:04:46 +11:00
Andrew Tridgell
856dfd0ee6
AC_AttitudeControl: fixed example build
2014-02-16 18:43:15 +11:00
Andrew Tridgell
ee37bc3d27
AP_AHRS: ensure we have HAL_CPU_CLASS available
2014-02-16 17:57:09 +11:00
Randy Mackay
6af705d455
AC_Circle: bug fix for pos target when radius is zero
2014-02-16 13:46:38 +11:00
Randy Mackay
9130c88f15
AC_PosControl: throttle rate to simple P controller
2014-02-16 13:35:44 +11:00
Randy Mackay
a021d0ca31
AHRS: fix compiler warning
2014-02-16 13:35:37 +11:00
Randy Mackay
34b62fc078
AC_AttControlHeli: add ACCEL_RP_MAX, ACCEL_Y_MAX
2014-02-16 13:35:26 +11:00
lthall
b8d9bdb794
AC_AttControl: accel limit for roll, pitch yaw rates
2014-02-16 13:35:23 +11:00
Andrew Tridgell
189d635493
AP_Compass: constrain compass offsets to +/- 2000
...
this is prompted by a user log showing NaN compass offsets, resulting
in a crash. The patch ensures we never end up with NaN offsets, and
also constrains the offsets to a reasonable limit
2014-02-16 13:33:41 +11:00
Andrew Tridgell
6618bdae67
DataFlash: periodically use lseek to avoid NuttX seek bug
2014-02-16 13:21:35 +11:00
Andrew Tridgell
9bb8f73d56
Compass: split compass learning out to its own C++ file
2014-02-16 13:21:06 +11:00
Andrew Tridgell
24e1070eb2
AP_NavEKF: initialise quaternion from rotation matrix
2014-02-15 12:21:11 +11:00
Andrew Tridgell
2df314799e
AP_Math: added tests for quaternion to/from rotation matrix
2014-02-15 12:20:51 +11:00
Andrew Tridgell
689f230d40
AP_Math: added quaternion.from_rotation_matrix()
2014-02-15 12:20:31 +11:00
Andrew Tridgell
c6b24c521b
AP_NavEKF: force healthy false when initialising
...
this prevents us feeding off our own values when booting
Pair-Programmed-With: Paul Riseborough <p_riseborough@live.com.au>
2014-02-15 09:25:40 +11:00
Andrew Tridgell
be33a9634e
AP_AHRS: move using_EKF to .cpp to make it easier in gdb
2014-02-15 09:25:40 +11:00
Andrew Tridgell
eedd88c2ec
AP_AHRS: give zero lat/lng and baro alt if no position yet in DCM
2014-02-15 09:25:40 +11:00
Andrew Tridgell
4d3f714a5d
AP_Notify: fixed example build
2014-02-15 06:40:39 +11:00
Andrew Tridgell
830afefcef
AP_HAL: fixed example build
2014-02-15 06:40:29 +11:00
Andrew Tridgell
3af38a778d
AP_Baro: fixed example build
2014-02-15 06:40:15 +11:00
Andrew Tridgell
8201f9c928
AP_NavEKF: don't build example
2014-02-15 06:40:06 +11:00
Andrew Tridgell
c1dff6aa65
AP_Math: fixed example build
2014-02-15 06:39:43 +11:00
Andrew Tridgell
f9d0747750
AP_InertialSensor: fixed example build
2014-02-15 06:39:35 +11:00
Randy Mackay
5bdc564191
AP_AHRS: fix example sketch
2014-02-15 06:09:08 +11:00
Randy Mackay
c18b3f6094
AP_Airspeed: fix example sketch
2014-02-15 06:09:08 +11:00
Randy Mackay
bb715424ee
Baro: fix BMP085 example sketch
2014-02-15 06:09:08 +11:00
Randy Mackay
d761ddd4af
AP_Motors: fix example sketch
2014-02-15 06:09:08 +11:00
Randy Mackay
ae59bef6d1
AC_INav: fix example sketch
2014-02-15 06:09:08 +11:00
Randy Mackay
42d9225fbe
HAL_AVR: ArduCopterLibs to use AC_P library
2014-02-15 06:09:08 +11:00
Randy Mackay
bf3effcd10
AC_WPNav: fix example sketch
2014-02-15 06:09:08 +11:00
Randy Mackay
889ee1bfef
AC_Sprayer: fix example sketch
2014-02-15 06:09:08 +11:00
Randy Mackay
4484a4232a
AC_Fence: fix example sketch
2014-02-15 06:09:08 +11:00
Randy Mackay
c35bd84e21
AC_AttControl: fix example sketch
2014-02-15 06:09:08 +11:00
Randy Mackay
451910fc94
AC_AttControlHeli: replace APM_PI with AC_P
2014-02-15 06:09:08 +11:00
Randy Mackay
ff9f4fe6e7
AC_AttControl: replace APM_PI with AC_P
2014-02-15 06:09:08 +11:00
Randy Mackay
94fb9c4274
AC_PosControl: replace APM_PI with AC_P
2014-02-15 06:09:08 +11:00
Randy Mackay
fbf8106280
AC_Circle: remove AC_PID include
...
This is no longer required with introduction of PosControl lib
2014-02-15 06:09:08 +11:00
Randy Mackay
e86a21a254
AC_WPNav: remove AC_PID include
...
This is no longer required with introduction of PosControl lib
2014-02-15 06:09:08 +11:00
Randy Mackay
8fae75ee87
AC_PID: add AC_P controller
...
Used for stabilize angle controllers, alt hold and loiter
2014-02-15 06:09:08 +11:00
Randy Mackay
fbc5af2705
AC_PID: results returned as float
2014-02-15 06:09:08 +11:00
Randy Mackay
a6ad51b38f
AC_AttControl: rename most methods
2014-02-15 06:09:08 +11:00
lthall
65c2fc0cc6
AC_AttControl: ACRO fixes
2014-02-15 06:09:08 +11:00
Andrew Tridgell
0bbe038587
GCS_MAVLink: re-generate MAVLink headers
2014-02-15 05:48:24 +11:00
Andrew Tridgell
801ceacaf2
AP_AHRS: re-run update_trig() after EKF AHRS update
2014-02-15 05:48:24 +11:00
Andrew Tridgell
a88212eb7a
AP_InertialNav: fixed EKF version for new AHRS API
2014-02-15 05:48:24 +11:00
Andrew Tridgell
a7a44a9a5c
AP_NavEKF: fixed init order warning
2014-02-15 05:48:24 +11:00
Andrew Tridgell
9b8311580b
AP_TECS: update for AHRS API change
2014-02-15 05:48:24 +11:00
Andrew Tridgell
25ef0d5a7b
AP_AHRS: don't allow get_velocity_NED() and get_relative_position_NED() without EKF
...
this avoids some linking issues, plus the functions are inaccurate
without EKF
2014-02-15 05:48:24 +11:00
Andrew Tridgell
6964529124
AP_Baro: _calculate can be private
2014-02-15 05:48:24 +11:00
Andrew Tridgell
c62ccce9d8
AP_AHRS: make estimate_wind() public
...
this avoids it linking into copter
2014-02-15 05:48:24 +11:00
Paul Riseborough
b56c8211c9
AP_NavEKF: Reduced number of Mavlink tuneable parameters
2014-02-15 05:48:23 +11:00
Paul Riseborough
c20fac1269
AP_NavEKF: Updated comments for private functions
2014-02-15 05:48:23 +11:00
Paul Riseborough
deb64c4cbd
AP_NavEKF: Pos Vel reset after long GPS timeout
2014-02-15 05:48:23 +11:00
Paul Riseborough
7ac0172db1
AP_NavEKF: removed repeated intialisation
2014-02-15 05:48:23 +11:00
Paul Riseborough
28fb5e364b
AP_NavEKF: Fixed bug in pos/vel/hgt reset on timout
2014-02-15 05:48:23 +11:00
Paul Riseborough
f74cce8b4e
AP_NavEKF : Removed double to float conversions
2014-02-15 05:48:23 +11:00
Paul Riseborough
80f6dba694
AP_NavEKF: Improved control of fusion update intervals
2014-02-15 05:48:23 +11:00
Paul Riseborough
13b9daeff5
AP_NavEKF: Added constraints to Mavlink tuneable parameters
2014-02-15 05:48:23 +11:00
Paul Riseborough
b123e1bb16
AP_NavEKF: Improved in-air reset behaviour
2014-02-15 05:48:22 +11:00
Paul Riseborough
1651980b9f
AP_NavEKF: Improved behaviour following loss and regaining of GPS
2014-02-15 05:48:22 +11:00
Paul Riseborough
14eb63e7c9
AP_NavEKF: Made most tuning parameters Mavlink adustable
2014-02-15 05:48:22 +11:00
Andrew Tridgell
f800f5592d
AP_NavEKF: fixup parameter handling
2014-02-15 05:48:22 +11:00
Andrew Tridgell
f09ae0c2d0
AP_AHRS: expose get_NavEKF as non-const
...
better than having two methods
2014-02-15 05:48:22 +11:00
Paul Riseborough
f0f76920fa
AP_NavEKF : Mavlink tunable parameter - first attempt
2014-02-15 05:48:22 +11:00
Paul Riseborough
128f71157d
AP_NavEKF: Fixed bug in pre GPS fix updates
2014-02-15 05:48:22 +11:00
Paul Riseborough
08267cea87
AP_AHRS: Scheduling for yaw gain to reduce atitude errors in turning flight
2014-02-15 05:48:22 +11:00
Paul Riseborough
357743ee2d
AP_NavEKF: Adjusted tuning parameters for plane use
2014-02-15 05:48:22 +11:00
Paul Riseborough
b4171853b1
AP_NavEKF: allow initialisation before GPS lock to aid indoor testing
2014-02-15 05:48:21 +11:00
Paul Riseborough
7fb60812c2
AP_NavEKF: Added pitch and roll inertial sensor to body trim adjustment
2014-02-15 05:48:21 +11:00
Paul Riseborough
9d375da550
AP_NavEKF: changed sqrt to sqrtf
2014-02-15 05:48:21 +11:00
Paul Riseborough
1f0b4b02d0
AP_NavEKF: fixed merge error that inverted static mode
2014-02-15 05:48:21 +11:00
Paul Riseborough
17e24521e8
DataFlash : Added logging of NavEKF innovations and variances
2014-02-15 05:48:21 +11:00
Paul Riseborough
9bbddb2f66
AP_TECS : Use NavEKF height and height rate data if available
2014-02-15 05:48:21 +11:00
Paul Riseborough
0599817aa9
AP_AHRS : EKF initialisation changed to use bootstrap method
2014-02-15 05:48:21 +11:00
Paul Riseborough
401e3aee43
AP_NavEKF : Changes to test harness to support accel bias states
2014-02-15 05:48:21 +11:00
Paul Riseborough
5219869389
AP_NavEKF : Added Z accel bias state and bootstrap initialisation method
2014-02-15 05:48:21 +11:00
Randy Mackay
301a04b74a
AP_NavEKF: update params for copter
2014-02-15 05:48:21 +11:00
Randy Mackay
f068d0ff7e
AP_AHRS_NavEKF: expose non-const EKF for tuning
2014-02-15 05:48:20 +11:00
Randy Mackay
7c73020015
AP_NavEKF: make params public so they can be tuned
2014-02-15 05:48:20 +11:00
Randy Mackay
9f130b40a0
AP_AHRS_NavEKF: override set_correct_centrifugal
2014-02-15 05:48:20 +11:00
Randy Mackay
8f6fd86f69
AP_AHRS: make set_correct_centrifugal virtual
2014-02-15 05:48:20 +11:00
Paul Riseborough
a87df0ad56
AP_AHRS : set NavEKF staticMode using call to set_correct_centrigual
2014-02-15 05:48:20 +11:00
Paul Riseborough
5c3dea28dc
AP_NavEKF : Enable staticMode to be set externally
2014-02-15 05:48:20 +11:00
Andrew Tridgell
3617c65af7
AP_InertialSensor: make HIL treat time like PX4 does
2014-02-15 05:48:20 +11:00
Andrew Tridgell
77c4968342
AP_NavEKF: enable plotting in plot2.dat too
2014-02-15 05:48:20 +11:00
Andrew Tridgell
ab2a5a0672
AP_NavEKF: enable some debug
2014-02-15 05:48:20 +11:00
Paul Riseborough
0d4d287215
AP_NavEKF: comment and parameter tweaks for ground testing
2014-02-15 05:48:20 +11:00
Paul Riseborough
b6b0c2a489
AP_NavEKF: fixed bug in flag reset for hgt fusion
2014-02-15 05:48:19 +11:00
Paul Riseborough
2f3b2a7111
AP_NavEKF: second attempt at higher rate baro fusion
2014-02-15 05:48:19 +11:00
Paul Riseborough
cdbc5a3f35
AP_NavEKF: added position observations to static mode
2014-02-15 05:48:19 +11:00
Paul Riseborough
da2c341914
Revert "AP_NavEKF: Modifed Vel Pos fusion to fuse height data whenever baro reading has changed"
...
This reverts commit d1e1be192a0e7ab0771edc9f2c03547da25697cf.
2014-02-15 05:48:19 +11:00
Paul Riseborough
32cc427ff4
AP_NavEKF: Modifed Vel Pos fusion to fuse height data whenever baro reading has changed
2014-02-15 05:48:19 +11:00
Paul Riseborough
2998aa1a6a
AP_NavEKF: Amended tuning parameter list, and changed from variance to noise definitions
2014-02-15 05:48:19 +11:00
Paul Riseborough
f9aae1b90b
AP_NavEKF: fixed bug in variance constraint code
2014-02-15 05:48:19 +11:00
Paul Riseborough
735c9684da
AP_NavEKF: removed error in constructor comments
2014-02-15 05:48:19 +11:00
Paul Riseborough
8f999fe787
AP_NavEKF: Misc tuning adjustments for Plane testing
2014-02-15 05:48:19 +11:00
Paul Riseborough
c87a5aaf34
AP_NavEKF: added PositionReset public function to fix pre-arm loss of solution
2014-02-15 05:48:19 +11:00
Paul Riseborough
fec4fd463c
AP_NavEKF: reduced On Ground yaw gyro bias drift variance scaler
2014-02-15 05:48:19 +11:00
Paul Riseborough
619fffec3e
AP_NavEKF: added static mode for pre-arm and bench testing
2014-02-15 05:48:18 +11:00
Paul Riseborough
ab08a5c7d6
AP_AHRS : altered NavEKF set home to reset position instead of reset filter
2014-02-15 05:48:18 +11:00
Paul Riseborough
d0831c708d
AP_NavEKF : Added position and height reset public method
2014-02-15 05:48:18 +11:00
Andrew Tridgell
1b1f9e41ab
AP_NavEKF: improved playback initialisation
2014-02-15 05:48:18 +11:00
Andrew Tridgell
d9ef45234b
AP_NavEKF: useful plotting function
2014-02-15 05:48:18 +11:00
Andrew Tridgell
0816642436
AP_NavEKF: handle intertial nav
2014-02-15 05:48:18 +11:00
Andrew Tridgell
77c6e3206a
AP_NavEKF: some debug code
2014-02-15 05:48:18 +11:00
Andrew Tridgell
2cd781997f
AP_Baro: changed HIL driver to use floats and better handle starup
2014-02-15 05:48:18 +11:00
Andrew Tridgell
c995f994c5
AP_InertialNav: make some functions protected
2014-02-15 05:48:18 +11:00
Andrew Tridgell
c33da7b3a2
AP_NavEKF: fixed log playback for copter
2014-02-15 05:48:18 +11:00
Andrew Tridgell
78ff078988
HAL_Linux: fixed stopped clock delay
2014-02-15 05:48:18 +11:00
Andrew Tridgell
9b53db66cb
AP_NavEKF: tweak parameters based on randys copter log
2014-02-15 05:48:18 +11:00
Andrew Tridgell
9e3bf685c2
SITL: use sinf() and cosf()
...
for some strange reason the double precision functions can crash
2014-02-15 05:48:17 +11:00
Andrew Tridgell
bb0eed5c14
SITL: prevent initialisation error
2014-02-15 05:48:17 +11:00
Andrew Tridgell
574946f0aa
AP_AHRS: start EKF 5 seconds after getting GPS lock
2014-02-15 05:48:17 +11:00
Andrew Tridgell
df271fbd59
AP_AHRS: fill in _dcm_matrix whenever EKF started
...
this ensures get_dcm_matrix() always returns valid data
2014-02-15 05:48:17 +11:00
Andrew Tridgell
4c42f53636
AP_NavEKF: use INS delta_time
2014-02-15 05:48:17 +11:00
Andrew Tridgell
5193ce90dc
AP_NavEKF: copter specific dtIMUAvg
2014-02-15 05:48:17 +11:00
Andrew Tridgell
ada7d4fb98
AP_AHRS: use the right DCM matrix when EKF not enabled
2014-02-15 05:48:17 +11:00
Andrew Tridgell
a74fcc5a93
AP_AHRS: added set_ekf_use()
2014-02-15 05:48:17 +11:00
Andrew Tridgell
38ac8d404a
SITL: fixed PX4 build
2014-02-15 05:48:17 +11:00
Andrew Tridgell
fba0891617
SITL: fixed SIM df altitude
2014-02-15 05:48:17 +11:00
Paul Riseborough
8b1d056e07
AP_NavEKF: updated timeout for GPS retry and reduced onGround gyro bias noise multiplier
2014-02-15 05:48:16 +11:00
Paul Riseborough
7e026d41df
AP_NavEKF: explicitly zeroed covariance matrix priro to setting initial values
2014-02-15 05:48:16 +11:00
Paul Riseborough
6e6e3d923e
AP_NavEKF: improved covariance matrix numerical stability protection
2014-02-15 05:48:16 +11:00
Andrew Tridgell
45177df354
DataFlash: moved EKF logging to common code
2014-02-15 05:48:16 +11:00
Andrew Tridgell
9aea781248
GCS_MAVLink: moved send_ahrs2 to common code
2014-02-15 05:48:16 +11:00
Andrew Tridgell
66dbaa6657
AP_NavEKF: make health() API const
2014-02-15 05:48:16 +11:00
Andrew Tridgell
47f541e143
AP_InertialNav: implement InertialNav in terms of AHRS when available
2014-02-15 05:48:16 +11:00
Andrew Tridgell
5d43a1d704
AP_AHRS: added inertial nav interfaces to AHRS
2014-02-15 05:48:16 +11:00
Andrew Tridgell
658110dd8c
AP_InertialNav: added AP_InertialNav_NavEKF wrapper class
2014-02-15 05:48:15 +11:00
Andrew Tridgell
99097d80a1
AP_InertialNav: use AHRS home location
2014-02-15 05:48:15 +11:00
Andrew Tridgell
c493d980d8
AP_NavEKF: fixed check for airspeed sensor available
2014-02-15 05:48:15 +11:00
Andrew Tridgell
2dbfed19b8
AP_NavEKF: fixed airspeed estimate check
2014-02-15 05:48:15 +11:00
Paul Riseborough
e69eea3086
AP_NavEKF: Bug fix in covariance error correction
2014-02-15 05:48:15 +11:00
Paul Riseborough
43dc9bc055
AP_NavEKF: Added improved covariance matrix error fix
2014-02-15 05:48:15 +11:00
Paul Riseborough
4a56ea84b5
AP_NavEKF: Removed accel bias states
2014-02-15 05:48:15 +11:00
Andrew Tridgell
093481786e
AP_NavEKF: added SIM state to playback tool
2014-02-15 05:48:15 +11:00
Andrew Tridgell
fcd9041e62
SITL: added dataflash logging
2014-02-15 05:48:14 +11:00
Andrew Tridgell
d0a25b53f2
DataFlash: added logging of AHRS2
2014-02-15 05:48:09 +11:00
Andrew Tridgell
5578552574
AP_NavEKF: fixed example for new API
2014-02-15 05:29:48 +11:00
Andrew Tridgell
2acf1e7ce5
AP_NavEKF: allow filter to run as single or double precision
...
useful for checking if there are numerical precision issues
2014-02-15 05:29:48 +11:00
Paul Riseborough
efd444b02e
AP_NavEKF: covariance protection (not enabled) and tuning changes for stability
2014-02-15 05:29:48 +11:00
Paul Riseborough
be9f276f45
AP_NavEKF: fixed compass offset sign error
2014-02-15 05:29:48 +11:00
Andrew Tridgell
ee774f69d0
AP_NavEKF: fixed some time handling bugs
...
use get_delta_time() and removed broken time wrap code
2014-02-15 05:29:48 +11:00
Andrew Tridgell
b1c5f23bbd
AP_InertialSensor: make get_delta_time() const
...
allows use from AP_NavEKF
2014-02-15 05:29:47 +11:00
Andrew Tridgell
95c5aeaa43
AP_NavEKF: removed more unused variables
2014-02-15 05:29:47 +11:00
Andrew Tridgell
a53fc0636a
AP_NavEKF: zero more variables on filter re-init
2014-02-15 05:29:47 +11:00
Andrew Tridgell
392995ef84
AP_AHRS: make AHRS handle altitude
...
AHRS now holds the home position
2014-02-15 05:29:47 +11:00
Andrew Tridgell
b9128a932f
AP_L1_Control: no need to project position for lag
...
now handled by AHRS
2014-02-15 05:29:47 +11:00
Andrew Tridgell
91cbad52a1
AP_NavEKF: handle conversion of AHRS to handle altitude
...
fixed accuracy of position for cm level lat/lng
2014-02-15 05:29:47 +11:00
Andrew Tridgell
1e476e511a
AP_AHRS: pass baro into AP_AHRS
...
first step in making AHRS handle altitude
2014-02-15 05:29:47 +11:00
Andrew Tridgell
6e5077b60b
AP_AHRS: removed unused AP_AHRS_HIL
2014-02-15 05:29:46 +11:00
Andrew Tridgell
84c7b0d7fd
AP_AHRS: check for NavEKF health
2014-02-15 05:29:46 +11:00
Andrew Tridgell
9ef71a9dec
AP_NavEKF: added healthy() API
2014-02-15 05:29:46 +11:00
Andrew Tridgell
cfc612b251
AP_InertialNav: use references to AHRS and baro
2014-02-15 05:29:45 +11:00
Andrew Tridgell
18aa08d5c3
GCS_MAVLink: added AHRS2 mavlink msg
2014-02-15 05:29:45 +11:00
Andrew Tridgell
154eb76f4f
GCS_MAVLink: new MAVLink headers
2014-02-15 05:29:45 +11:00
Andrew Tridgell
bfd48a95b7
AP_NavEKF: fixed example build
2014-02-15 05:29:45 +11:00
Andrew Tridgell
b39a5062e9
AP_AHRS: use NavEKF for ground vector when available
2014-02-15 05:29:45 +11:00
Andrew Tridgell
b6bc50051f
AP_AHRS: allow reporting of secondary AHRS solution
2014-02-15 05:29:45 +11:00
Andrew Tridgell
ea0f9392ef
AP_NavEKF: don't report altitude yet, and removed debug code
2014-02-15 05:29:45 +11:00
Andrew Tridgell
a1aebc0c15
GCS_MAVLink: update from upstream
2014-02-15 05:29:23 +11:00
Andrew Tridgell
0e10554dc0
GCS_MAVLink: rename EKF message to AHRS2
2014-02-15 05:28:10 +11:00
Andrew Tridgell
33673c954d
AP_NavEKF: implemented getRotationBodyToNED()
2014-02-15 05:28:10 +11:00
Andrew Tridgell
8c5cde4efd
AP_AHRS: allow NavEKF to be enabled at runtime with AHRS_EKF_USE=1
2014-02-15 05:28:10 +11:00
Andrew Tridgell
7ac78ff991
AP_AHRS: create AP_AHRS_NavEKF class
...
subclass of AP_AHRS_DCM, just a wrapper for now, will add EKF calls
next
2014-02-15 05:28:09 +11:00
Andrew Tridgell
2c86a490ed
AP_NavEKF: make it possible for NavEKF to be a AHRS member
...
ready for AHRS integration
2014-02-15 05:28:09 +11:00
Paul Riseborough
6f31961fb5
AP_NavEKF: Added height rate adaptive wind speed process noise
2014-02-15 05:28:09 +11:00
Paul Riseborough
de884dabab
AP_NavEKF: brought some tuning parameters out to header
2014-02-15 05:28:09 +11:00
Paul Riseborough
3ee5ef852b
AP_NavEKF : improved On Ground check
2014-02-15 05:28:09 +11:00
Paul Riseborough
8bc14d09b2
AP_NavEKF : remove onGround airspeed detect bug
2014-02-15 05:28:09 +11:00
Paul Riseborough
a507fa7570
AP_NavEKF : remove debug code
2014-02-15 05:28:09 +11:00
Paul Riseborough
2f95685bfc
Plane : EKF data logging fixes
2014-02-15 05:28:09 +11:00
Paul Riseborough
6b9733c013
AP_NavEKF : Additional flash logging
2014-02-15 05:28:09 +11:00
Paul Riseborough
c28e89e4b7
AP_NavEKF: bug fixes for height fusion and covariance initialisation
2014-02-15 05:28:08 +11:00
Paul Riseborough
aed6c79135
AP_NavEKF: Added gyro bias variance scale for on-ground
2014-02-15 05:28:08 +11:00
Paul Riseborough
cb42e1e490
AP_NavEKF: Added public function to get NED position
2014-02-15 05:28:08 +11:00
Paul Riseborough
2c567cd721
AP_NavEKF: Added tuning parameter for onGround yaw gyro variance
2014-02-15 05:28:08 +11:00
Paul Riseborough
9515f6c745
AP_NavEKF: Cleaned up on-ground state and covariance update logic
2014-02-15 05:28:08 +11:00
Andrew Tridgell
9c5647eef3
AP_NavEKF: stop log for gdb friendly playback
2014-02-15 05:28:08 +11:00
Andrew Tridgell
117b77460e
HAL_Linux: added stop_clock hack!
2014-02-15 05:28:08 +11:00
Andrew Tridgell
4adf6000f3
AP_NavEKF: only build on fast CPUs
2014-02-15 05:28:08 +11:00
Paul Riseborough
1647ba9bd0
AP_NavEKF: Reduced heading drift on ground
2014-02-15 05:28:08 +11:00
Paul Riseborough
63d8b1bb0b
AP_NavEKF: Scheduler Improvements
2014-02-15 05:28:07 +11:00
Andrew Tridgell
df42dd691c
AP_NavEKF: added perf counters on PX4
2014-02-15 05:28:07 +11:00
Andrew Tridgell
3d6cb9eade
AP_NavEKF: use float arrays when not doing bounds checking
...
g++ is doing a lousy job of inlining VectorN, so avoid it when we
don't need bounds checking for production code
2014-02-15 05:28:07 +11:00
Andrew Tridgell
c7533579ac
AP_AHRS: added get_airspeed() interface to AHRS
2014-02-15 05:28:07 +11:00
Andrew Tridgell
010250a966
AP_NavEKF: use quaternion normalize and cleanup sqrt calls
2014-02-15 05:28:07 +11:00
Paul Riseborough
406fb31a57
AP_NavEKF: Load levelling scheduler - first attempt
2014-02-15 05:28:07 +11:00
Andrew Tridgell
68283b7aa1
GCS_MAVLink: new ekf header
2014-02-15 05:28:07 +11:00
Andrew Tridgell
163cfd839d
AP_NavEKF: enable airspeed and fix getLLH()
2014-02-15 05:28:07 +11:00
Andrew Tridgell
b4153c4d32
GCS_MAVLink: added EKF message for debugging
2014-02-15 05:27:54 +11:00
Andrew Tridgell
4771a4fc77
AP_NavEKF: use radians values from AHRS directly
2014-02-15 05:27:53 +11:00
Paul Riseborough
6b798d2821
AP_NavEKF: first working GPS + Mag fusion
2014-02-15 05:27:53 +11:00
Paul Riseborough
bccadb6e25
AP_NavEKF: first working GPS fusion
2014-02-15 05:27:53 +11:00
Andrew Tridgell
90cd04def3
AP_NavEKF: fixed build for non-Linux
2014-02-15 05:27:53 +11:00
Andrew Tridgell
0b71618f4f
AP_NavEKF: use vectorN to make indexes safe
2014-02-15 05:27:53 +11:00
Andrew Tridgell
e972acbc9f
AP_NavEKF: removed delay callback
2014-02-15 05:27:53 +11:00
Andrew Tridgell
8f16647a0c
AP_NavEKF: added write_flot valgrind functions
2014-02-15 05:27:53 +11:00
Andrew Tridgell
a8ddd51355
AP_NavEKF: added pause to gnuplot scripts
2014-02-15 05:27:53 +11:00
Andrew Tridgell
4298625daf
AP_NavEKF: added convenient plotting scripts
2014-02-15 05:27:53 +11:00
Paul Riseborough
fca1090694
AP_NavEKF: debug updates
2014-02-15 05:27:53 +11:00
Andrew Tridgell
95f51123d7
AP_NavEKF: added plot.dat output
2014-02-15 05:27:53 +11:00
Andrew Tridgell
050b0fb9f1
AP_NavEKF: fixed compass declination, baro cal and time shift
...
now runs much faster
2014-02-15 05:27:53 +11:00
Andrew Tridgell
776cedf368
AP_NavEKF: try running EKF on log data
2014-02-15 05:27:52 +11:00
Andrew Tridgell
ffce1f64cc
AP_NavEKF: added euler angle functions
2014-02-15 05:27:52 +11:00
Andrew Tridgell
977ad4bbf6
AP_NavEKF: added dataflash log reader
...
this gives log playback into HIL
2014-02-15 05:27:52 +11:00
Andrew Tridgell
f3dfde2025
AP_NavEKF: initial test sketch for NavEKF
2014-02-15 05:27:52 +11:00
Paul Riseborough
361bb5b18f
AP_NavEKF: Updated comments in header file
2014-02-15 05:27:52 +11:00
Paul Riseborough
00df068967
AP_NavEKF: Explicitly defined numerical constants as single precision using f suffix
2014-02-15 05:27:52 +11:00
Andrew Tridgell
eb505eef91
AP_NavEKF: fixed build for APM environment
2014-02-15 05:27:52 +11:00
Paul Riseborough
0dd5463e77
AP_NavEKF : Changed file and variable names
2014-02-15 05:27:52 +11:00