priseborough
2ee1c549be
AP_NavEKF : improve criteria used to inhibit scale factor estimation
2014-12-06 18:16:46 +11:00
priseborough
e09ff84218
AP_NavEKF : Don't estimate focal length scale factor without reliable velocity
2014-12-06 18:16:46 +11:00
priseborough
4c92a5f23f
AP_NavEKF : Use GPS velocity if PX4Flow sensor fails
2014-12-06 18:16:46 +11:00
priseborough
283811edcb
AP_NavEKF : stop velocity change when flow measurements drop out
2014-12-06 18:16:46 +11:00
priseborough
9132fcfe43
AP_NavEKF : Change mag fusion to use corrected compass values
...
This enables compass units to be switched in-flight
2014-12-06 18:16:46 +11:00
priseborough
c3be486c29
AP_NavEKF : Enable inhibiting of GPS measurements
2014-12-06 18:16:45 +11:00
priseborough
79698f7742
AP_NavEKF : improvements to range finder fusion
2014-12-06 18:16:45 +11:00
priseborough
1222559da0
AP_NavEKF : Fix bug affecting sonar fusion
2014-12-06 18:16:45 +11:00
priseborough
117bd2a998
AP_NavEKF : Add time based noise to terrain offset state
2014-12-06 18:16:45 +11:00
priseborough
b1d3d5d9a3
AP_NavEKF : Don't update focal length scale factor at low speeds
2014-12-06 18:16:45 +11:00
priseborough
8dd1081f54
AP_NavEKF : Add range measurement to EKF debug message
2014-12-06 18:16:45 +11:00
priseborough
f358d5e20f
DataFlash : Add range measurement to EKF debug message
2014-12-06 18:16:45 +11:00
priseborough
744c72d40b
AP_NavEKF : Updates to range finder fusion
2014-12-06 18:16:45 +11:00
priseborough
9707989b9f
Plane : Preliminary optical flow integration
2014-12-06 18:16:45 +11:00
priseborough
267ef48026
Copter : disable tilt correction of range finder data for use by EKF
...
This is a temporary fix. We need to make separate range and altitude measurements available.
2014-12-06 18:16:45 +11:00
priseborough
a07e402ebf
DataFlash : Update names in EKF optical flow logging
2014-12-06 18:16:45 +11:00
priseborough
a20729f60f
AP_NavEKF : Update names in optical flow debug logging
2014-12-06 18:16:45 +11:00
priseborough
235b3bebda
AP_NavEKF : Add range finder health and enable range finder fusion
...
The 2-state auxiliary filter is also renamed.
2014-12-06 18:16:45 +11:00
priseborough
a4984a1e76
AP_AHRS : Add range finder health status to EKF optical flow data
2014-12-06 18:16:44 +11:00
priseborough
27f9289391
Copter : Add range finder measurements to EKF optical flow data
2014-12-06 18:16:44 +11:00
priseborough
988de2a898
AP_NavEKF : Add smoothing to optical flow fusion
2014-12-06 18:16:44 +11:00
priseborough
70c779dbc2
AP_NavEKF : Optical flow numerical optimisations
2014-12-06 18:16:44 +11:00
priseborough
2a1420171a
AP_NavEKF : reduce minimum accepted flow quality
2014-12-06 18:16:44 +11:00
priseborough
3fbedc9f98
AP_NAvEKF : update comments
2014-12-06 18:16:44 +11:00
priseborough
81b09c9361
AP_NavEKF : temporary mods to test use of flow sensor internal gyro data
2014-12-06 18:16:44 +11:00
priseborough
12b012a00e
AP_AHRS : temporary mods to test use of flow sensor internal gyro data
2014-12-06 18:16:44 +11:00
priseborough
635e593d55
Copter : temporary mods to test use of flow sensor internal gyro data
2014-12-06 18:16:44 +11:00
priseborough
cd418c946c
AP_NavEKF : preliminary implementation for optical flow and range finder fusion
...
Range finder measurements are not input to EKF at this time, however the method for fusing them is
implemented.
2014-12-06 18:16:44 +11:00
priseborough
bc74abcd00
DataFlash : EKF optical flow fusion support preliminary changes
2014-12-06 18:16:44 +11:00
priseborough
7b76fc29fb
AP_AHRS : EKF optical flow fusion support preliminary changes
2014-12-06 18:16:44 +11:00
priseborough
34249ffa42
Copter : EKF optical flow fusion support preliminary changes
...
Assumes optflow sensor has been modified to push data at a low rate, eg 10Hz
and velocity data is angular velocity, not linear velocity
2014-12-06 18:16:44 +11:00
Randy Mackay
8b80e58861
Copter: enable OPTFLOW - do not merge to master
2014-12-06 18:16:44 +11:00
Randy Mackay
9d5c27ca83
PX4: start px4flow driver
2014-12-06 18:16:43 +11:00
priseborough
13df6fb1c9
AP_NavEKF : Reduce ripple in estimates that can cause copter motor 'pulsing'
...
This patch reduces the level of 5Hz and 10Hz 'pulsing' heard in motors due to GPS and altimeter fusion which cause a small 5Hz and 10Hz ripple on the output under some conditions. Attitude, velocity and position state corrections from GPS, altimeter and magnetometer measurements are applied incrementally in the interval from receiving the measurement to the predicted time of receipt of the next measurement. Averaging of attitude state corrections is not performed during periods of rapid rotation.
Time stamps are now explicitly initialised to the current IMU time to avoid unwanted activation of timeout logic on filter start and the various calls to the hal.scheduler->millis() object have been consolidated.
Unused variables have been removed
2014-12-06 18:16:43 +11:00
priseborough
dcb252cc05
AP_NavEKF : Fix bug in reset of position and velocity states
...
If the inertial solution velocity or position needs to be reset to the GPS, the stored state history for the corresponding states should also be reset.
Otherwise the next GPS measurement will be compared to an invalid previous state and will be rejected.
The position state should be reset to a GPS position corrected for velocity and measurement latency. This will make a noticeable difference for high speed flight vehicles, eg 11m at 50m/s
2014-12-06 18:16:43 +11:00
priseborough
cb4d5986e0
AP_OpticalFlow : Update PX4Flow interface
...
Interface now uses the integral of flow and body rates
2014-12-06 18:16:43 +11:00
priseborough
0d774d301d
AP_OpticalFlow : Remove support for ADNS3080 sensor
...
It is not compatible with the new interface and data fusion requirements
2014-12-06 18:16:43 +11:00
priseborough
60527a023a
Copter : Update optical flow test for new PX4Flow interface
2014-12-06 18:16:43 +11:00
priseborough
0d7555b259
Copter : Remove legacy optical flow control mode
...
This mode is not compatible with the new PX4Flow interface
2014-12-06 18:16:43 +11:00
priseborough
900519b35b
Copter : Remove legacy optical flow control mode
...
This mode is not compatible with the new PX4Flow interface
2014-12-06 18:16:43 +11:00
priseborough
23953b459e
Copter : Update logging for new PX4Flow sensor interface
2014-12-06 18:16:43 +11:00
priseborough
20e715aa13
Copter : Remove ADNS3080 flow sensor support
2014-12-06 18:16:43 +11:00
priseborough
5ef2208017
Copter: Change flow sensor read sample rate to 10Hz
2014-12-06 18:16:43 +11:00
Randy Mackay
4452aa8448
AP_AHRS_DCM: compile error fix for low speed CPUs
...
Also correct initialisatoin order to remove compiler warning
2014-12-05 19:43:05 +09:00
Jonathan Challinger
bfe71fea82
AC_PosControl: Use blended accelerometer measurement in altitude control
2014-12-05 19:40:10 +09:00
Jonathan Challinger
9261dfdefb
AP_AHRS_NavEKF: overload get_accel_ef and get_accel_ef_blended functions
2014-12-05 19:40:08 +09:00
Jonathan Challinger
4975cefd84
AP_AHRS_DCM: update _accel_ef_blended
2014-12-05 19:40:06 +09:00
Jonathan Challinger
033ee3c900
AP_AHRS: Add get_accel_ef_blended function
2014-12-05 19:40:04 +09:00
Jonathan Challinger
7692761f34
AP_NavEKF: Added getAccelNED function
2014-12-05 19:40:01 +09:00
Randy Mackay
7be78621f4
Copter: run_nav_updates at 50hz on Pixhawk, 25hz on APM2
...
Based on work by Jon Challinger (see earlier commit)
2014-12-05 14:01:16 +09:00
