2014-01-30 17:47:33 -04:00
|
|
|
/// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*-
|
|
|
|
/*
|
2014-03-08 16:51:45 -04:00
|
|
|
22 state EKF based on https://github.com/priseborough/InertialNav
|
2014-01-30 17:47:33 -04:00
|
|
|
|
|
|
|
Converted from Matlab to C++ by Paul Riseborough
|
|
|
|
|
|
|
|
This program is free software: you can redistribute it and/or modify
|
|
|
|
it under the terms of the GNU General Public License as published by
|
|
|
|
the Free Software Foundation, either version 3 of the License, or
|
|
|
|
(at your option) any later version.
|
|
|
|
|
|
|
|
This program is distributed in the hope that it will be useful,
|
|
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
GNU General Public License for more details.
|
|
|
|
|
|
|
|
You should have received a copy of the GNU General Public License
|
|
|
|
along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
|
*/
|
2016-02-17 21:25:40 -04:00
|
|
|
#pragma once
|
2014-01-30 17:47:33 -04:00
|
|
|
|
2015-08-11 03:28:44 -03:00
|
|
|
#include <AP_Math/AP_Math.h>
|
|
|
|
#include <AP_InertialSensor/AP_InertialSensor.h>
|
|
|
|
#include <AP_Baro/AP_Baro.h>
|
|
|
|
#include <AP_Airspeed/AP_Airspeed.h>
|
|
|
|
#include <AP_Compass/AP_Compass.h>
|
|
|
|
#include <AP_Param/AP_Param.h>
|
|
|
|
#include "AP_Nav_Common.h"
|
|
|
|
#include <GCS_MAVLink/GCS_MAVLink.h>
|
|
|
|
#include <AP_RangeFinder/AP_RangeFinder.h>
|
2013-12-30 06:27:50 -04:00
|
|
|
|
2015-08-11 03:28:44 -03:00
|
|
|
#include <AP_Math/vectorN.h>
|
2014-01-30 17:47:33 -04:00
|
|
|
|
2015-09-22 10:13:16 -03:00
|
|
|
// GPS pre-flight check bit locations
|
|
|
|
#define MASK_GPS_NSATS (1<<0)
|
|
|
|
#define MASK_GPS_HDOP (1<<1)
|
|
|
|
#define MASK_GPS_SPD_ERR (1<<2)
|
|
|
|
#define MASK_GPS_POS_ERR (1<<3)
|
|
|
|
#define MASK_GPS_YAW_ERR (1<<4)
|
|
|
|
#define MASK_GPS_POS_DRIFT (1<<5)
|
|
|
|
#define MASK_GPS_VERT_SPD (1<<6)
|
|
|
|
#define MASK_GPS_HORIZ_SPD (1<<7)
|
2013-12-30 06:27:50 -04:00
|
|
|
|
2014-01-01 21:15:22 -04:00
|
|
|
class AP_AHRS;
|
2015-11-04 19:34:57 -04:00
|
|
|
class NavEKF_core;
|
2014-01-01 21:15:22 -04:00
|
|
|
|
2014-01-30 17:47:33 -04:00
|
|
|
class NavEKF
|
|
|
|
{
|
2015-11-04 19:34:57 -04:00
|
|
|
friend class NavEKF_core;
|
|
|
|
|
2014-01-30 17:47:33 -04:00
|
|
|
public:
|
2014-01-03 03:52:37 -04:00
|
|
|
// Constructor
|
2015-04-17 06:22:51 -03:00
|
|
|
NavEKF(const AP_AHRS *ahrs, AP_Baro &baro, const RangeFinder &rng);
|
2014-01-03 03:52:37 -04:00
|
|
|
|
2015-11-06 07:50:15 -04:00
|
|
|
// allow logging to determine if the EKF is enabled
|
|
|
|
bool enabled(void) const {
|
|
|
|
return (_enable != 0);
|
|
|
|
}
|
|
|
|
|
2014-03-11 06:18:01 -03:00
|
|
|
// This function is used to initialise the filter whilst moving, using the AHRS DCM solution
|
|
|
|
// It should NOT be used to re-initialise after a timeout as DCM will also be corrupted
|
2015-03-28 14:51:38 -03:00
|
|
|
bool InitialiseFilterDynamic(void);
|
2013-12-29 03:37:55 -04:00
|
|
|
|
2014-01-20 15:52:27 -04:00
|
|
|
// Initialise the states from accelerometer and magnetometer data (if present)
|
|
|
|
// This method can only be used when the vehicle is static
|
2015-03-28 14:51:38 -03:00
|
|
|
bool InitialiseFilterBootstrap(void);
|
2014-01-30 18:25:40 -04:00
|
|
|
|
2014-01-30 17:47:33 -04:00
|
|
|
// Update Filter States - this should be called whenever new IMU data is available
|
2013-12-29 03:37:55 -04:00
|
|
|
void UpdateFilter(void);
|
|
|
|
|
2014-03-11 06:18:01 -03:00
|
|
|
// Check basic filter health metrics and return a consolidated health status
|
2014-01-03 20:16:19 -04:00
|
|
|
bool healthy(void) const;
|
2014-01-02 01:16:16 -04:00
|
|
|
|
2015-04-29 07:18:37 -03:00
|
|
|
// Return the last calculated NED position relative to the reference point (m).
|
|
|
|
// If a calculated solution is not available, use the best available data and return false
|
|
|
|
// If false returned, do not use for flight control
|
2014-01-01 21:15:22 -04:00
|
|
|
bool getPosNED(Vector3f &pos) const;
|
2013-12-29 03:37:55 -04:00
|
|
|
|
2013-12-31 23:03:52 -04:00
|
|
|
// return NED velocity in m/s
|
2014-01-01 21:15:22 -04:00
|
|
|
void getVelNED(Vector3f &vel) const;
|
2014-01-30 17:47:33 -04:00
|
|
|
|
2015-10-11 19:50:35 -03:00
|
|
|
// Return the rate of change of vertical position in the down diection (dPosD/dt) in m/s
|
|
|
|
// This can be different to the z component of the EKF velocity state because it will fluctuate with height errors and corrections in the EKF
|
|
|
|
// but will always be kinematically consistent with the z component of the EKF position state
|
2015-10-15 02:32:47 -03:00
|
|
|
float getPosDownDerivative(void) const;
|
2015-10-11 19:50:35 -03:00
|
|
|
|
2014-10-31 19:06:04 -03:00
|
|
|
// This returns the specific forces in the NED frame
|
|
|
|
void getAccelNED(Vector3f &accelNED) const;
|
|
|
|
|
2014-03-11 06:18:01 -03:00
|
|
|
// return body axis gyro bias estimates in rad/sec
|
2014-01-01 21:15:22 -04:00
|
|
|
void getGyroBias(Vector3f &gyroBias) const;
|
2013-12-31 17:54:56 -04:00
|
|
|
|
2014-10-28 22:21:42 -03:00
|
|
|
// reset body axis gyro bias estimates
|
|
|
|
void resetGyroBias(void);
|
|
|
|
|
2015-06-23 19:53:04 -03:00
|
|
|
// Resets the baro so that it reads zero at the current height
|
|
|
|
// Resets the EKF height to zero
|
|
|
|
// Adjusts the EKf origin height so that the EKF height + origin height is the same as before
|
|
|
|
// Returns true if the height datum reset has been performed
|
|
|
|
// If using a range finder for height no reset is performed and it returns false
|
|
|
|
bool resetHeightDatum(void);
|
|
|
|
|
2014-11-15 16:03:17 -04:00
|
|
|
// Commands the EKF to not use GPS.
|
2014-11-12 06:04:58 -04:00
|
|
|
// This command must be sent prior to arming as it will only be actioned when the filter is in static mode
|
|
|
|
// This command is forgotten by the EKF each time it goes back into static mode (eg the vehicle disarms)
|
2014-11-15 16:03:17 -04:00
|
|
|
// Returns 0 if command rejected
|
|
|
|
// Returns 1 if attitude, vertical velocity and vertical position will be provided
|
|
|
|
// Returns 2 if attitude, 3D-velocity, vertical position and relative horizontal position will be provided
|
2014-11-12 06:04:58 -04:00
|
|
|
uint8_t setInhibitGPS(void);
|
|
|
|
|
2014-11-15 21:41:27 -04:00
|
|
|
// return the horizontal speed limit in m/s set by optical flow sensor limits
|
|
|
|
// return the scale factor to be applied to navigation velocity gains to compensate for increase in velocity noise with height when using optical flow
|
|
|
|
void getEkfControlLimits(float &ekfGndSpdLimit, float &ekfNavVelGainScaler) const;
|
2014-11-15 02:44:25 -04:00
|
|
|
|
2014-10-30 03:42:47 -03:00
|
|
|
// return weighting of first IMU in blending function
|
|
|
|
void getIMU1Weighting(float &ret) const;
|
|
|
|
|
|
|
|
// return the individual Z-accel bias estimates in m/s^2
|
|
|
|
void getAccelZBias(float &zbias1, float &zbias2) const;
|
2013-12-31 17:54:56 -04:00
|
|
|
|
2014-03-11 06:18:01 -03:00
|
|
|
// return the NED wind speed estimates in m/s (positive is air moving in the direction of the axis)
|
2014-01-01 21:15:22 -04:00
|
|
|
void getWind(Vector3f &wind) const;
|
2014-01-30 18:11:54 -04:00
|
|
|
|
2014-03-11 06:18:01 -03:00
|
|
|
// return earth magnetic field estimates in measurement units / 1000
|
2014-01-01 21:15:22 -04:00
|
|
|
void getMagNED(Vector3f &magNED) const;
|
2013-12-31 17:54:56 -04:00
|
|
|
|
2014-03-11 06:18:01 -03:00
|
|
|
// return body magnetic field estimates in measurement units / 1000
|
2014-01-01 21:15:22 -04:00
|
|
|
void getMagXYZ(Vector3f &magXYZ) const;
|
2013-12-31 17:54:56 -04:00
|
|
|
|
2015-03-16 16:05:45 -03:00
|
|
|
// Return estimated magnetometer offsets
|
|
|
|
// Return true if magnetometer offsets are valid
|
2016-03-29 17:05:19 -03:00
|
|
|
bool getMagOffsets(uint8_t mag_idx, Vector3f &magOffsets) const;
|
2015-03-16 16:05:45 -03:00
|
|
|
|
2015-04-29 06:54:50 -03:00
|
|
|
// Return the last calculated latitude, longitude and height in WGS-84
|
2015-05-02 04:32:57 -03:00
|
|
|
// If a calculated location isn't available, return a raw GPS measurement
|
|
|
|
// The status will return true if a calculation or raw measurement is available
|
|
|
|
// The getFilterStatus() function provides a more detailed description of data health and must be checked if data is to be used for flight control
|
2014-01-01 21:15:22 -04:00
|
|
|
bool getLLH(struct Location &loc) const;
|
2014-01-30 17:47:33 -04:00
|
|
|
|
2015-01-07 22:43:41 -04:00
|
|
|
// return the latitude and longitude and height used to set the NED origin
|
|
|
|
// All NED positions calculated by the filter are relative to this location
|
|
|
|
// Returns false if the origin has not been set
|
|
|
|
bool getOriginLLH(struct Location &loc) const;
|
|
|
|
|
|
|
|
// set the latitude and longitude and height used to set the NED origin
|
|
|
|
// All NED positions calcualted by the filter will be relative to this location
|
|
|
|
// The origin cannot be set if the filter is in a flight mode (eg vehicle armed)
|
|
|
|
// Returns false if the filter has rejected the attempt to set the origin
|
|
|
|
bool setOriginLLH(struct Location &loc);
|
|
|
|
|
2014-11-30 05:26:11 -04:00
|
|
|
// return estimated height above ground level
|
|
|
|
// return false if ground height is not being estimated.
|
|
|
|
bool getHAGL(float &HAGL) const;
|
|
|
|
|
2013-12-29 03:37:55 -04:00
|
|
|
// return the Euler roll, pitch and yaw angle in radians
|
2014-01-01 21:15:22 -04:00
|
|
|
void getEulerAngles(Vector3f &eulers) const;
|
2014-01-30 17:47:33 -04:00
|
|
|
|
2014-03-11 06:18:01 -03:00
|
|
|
// return the transformation matrix from XYZ (body) to NED axes
|
2014-01-01 21:15:22 -04:00
|
|
|
void getRotationBodyToNED(Matrix3f &mat) const;
|
2014-01-30 17:47:33 -04:00
|
|
|
|
2014-03-11 06:18:01 -03:00
|
|
|
// return the quaternions defining the rotation from NED to XYZ (body) axes
|
2014-01-01 21:15:22 -04:00
|
|
|
void getQuaternion(Quaternion &quat) const;
|
2014-01-30 17:47:33 -04:00
|
|
|
|
2014-01-30 18:25:40 -04:00
|
|
|
// return the innovations for the NED Pos, NED Vel, XYZ Mag and Vtas measurements
|
|
|
|
void getInnovations(Vector3f &velInnov, Vector3f &posInnov, Vector3f &magInnov, float &tasInnov) const;
|
|
|
|
|
2014-03-31 18:15:28 -03:00
|
|
|
// return the innovation consistency test ratios for the velocity, position, magnetometer and true airspeed measurements
|
2014-04-02 17:46:56 -03:00
|
|
|
void getVariances(float &velVar, float &posVar, float &hgtVar, Vector3f &magVar, float &tasVar, Vector2f &offset) const;
|
2014-01-30 18:25:40 -04:00
|
|
|
|
2014-08-24 08:00:24 -03:00
|
|
|
// should we use the compass? This is public so it can be used for
|
|
|
|
// reporting via ahrs.use_compass()
|
|
|
|
bool use_compass(void) const;
|
|
|
|
|
2014-08-25 04:58:42 -03:00
|
|
|
// write the raw optical flow measurements
|
|
|
|
// rawFlowQuality is a measured of quality between 0 and 255, with 255 being the best quality
|
2014-11-12 01:33:05 -04:00
|
|
|
// rawFlowRates are the optical flow rates in rad/sec about the X and Y sensor axes.
|
|
|
|
// rawGyroRates are the sensor rotation rates in rad/sec measured by the sensors internal gyro
|
|
|
|
// The sign convention is that a RH physical rotation of the sensor about an axis produces both a positive flow and gyro rate
|
2014-08-25 04:58:42 -03:00
|
|
|
// msecFlowMeas is the scheduler time in msec when the optical flow data was received from the sensor.
|
2015-04-17 06:22:51 -03:00
|
|
|
void writeOptFlowMeas(uint8_t &rawFlowQuality, Vector2f &rawFlowRates, Vector2f &rawGyroRates, uint32_t &msecFlowMeas);
|
2014-08-25 04:58:42 -03:00
|
|
|
|
|
|
|
// return data for debugging optical flow fusion
|
2015-01-03 19:27:07 -04:00
|
|
|
void getFlowDebug(float &varFlow, float &gndOffset, float &flowInnovX, float &flowInnovY, float &auxInnov, float &HAGL, float &rngInnov, float &range, float &gndOffsetErr) const;
|
2014-08-25 04:58:42 -03:00
|
|
|
|
2015-04-20 19:41:42 -03:00
|
|
|
// called by vehicle code to specify that a takeoff is happening
|
|
|
|
// causes the EKF to compensate for expected barometer errors due to ground effect
|
|
|
|
void setTakeoffExpected(bool val);
|
|
|
|
|
|
|
|
// called by vehicle code to specify that a touchdown is expected to happen
|
|
|
|
// causes the EKF to compensate for expected barometer errors due to ground effect
|
|
|
|
void setTouchdownExpected(bool val);
|
2015-01-28 02:02:59 -04:00
|
|
|
|
2014-05-12 04:35:22 -03:00
|
|
|
/*
|
|
|
|
return the filter fault status as a bitmasked integer
|
2014-11-01 04:04:18 -03:00
|
|
|
0 = quaternions are NaN
|
|
|
|
1 = velocities are NaN
|
2014-05-12 04:35:22 -03:00
|
|
|
2 = badly conditioned X magnetometer fusion
|
|
|
|
3 = badly conditioned Y magnetometer fusion
|
2015-09-24 03:23:20 -03:00
|
|
|
4 = badly conditioned Z magnetometer fusion
|
|
|
|
5 = badly conditioned airspeed fusion
|
|
|
|
6 = badly conditioned synthetic sideslip fusion
|
2014-11-01 04:04:18 -03:00
|
|
|
7 = filter is not initialised
|
2014-05-12 04:35:22 -03:00
|
|
|
*/
|
2014-10-14 04:24:32 -03:00
|
|
|
void getFilterFaults(uint8_t &faults) const;
|
2014-05-12 04:35:22 -03:00
|
|
|
|
2014-11-01 04:04:18 -03:00
|
|
|
/*
|
|
|
|
return filter timeout status as a bitmasked integer
|
|
|
|
0 = position measurement timeout
|
|
|
|
1 = velocity measurement timeout
|
|
|
|
2 = height measurement timeout
|
|
|
|
3 = magnetometer measurement timeout
|
2015-09-24 03:23:20 -03:00
|
|
|
4 = true airspeed measurement timeout
|
2014-11-01 04:04:18 -03:00
|
|
|
5 = unassigned
|
|
|
|
6 = unassigned
|
|
|
|
7 = unassigned
|
|
|
|
*/
|
|
|
|
void getFilterTimeouts(uint8_t &timeouts) const;
|
|
|
|
|
2014-11-14 01:22:16 -04:00
|
|
|
/*
|
2015-01-02 04:07:42 -04:00
|
|
|
return filter status flags
|
2014-11-14 01:22:16 -04:00
|
|
|
*/
|
2015-01-02 04:07:42 -04:00
|
|
|
void getFilterStatus(nav_filter_status &status) const;
|
2014-11-14 01:22:16 -04:00
|
|
|
|
2015-10-08 16:34:23 -03:00
|
|
|
/*
|
|
|
|
return filter gps quality check status
|
|
|
|
*/
|
|
|
|
void getFilterGpsStatus(nav_gps_status &status) const;
|
|
|
|
|
2015-03-10 04:00:32 -03:00
|
|
|
// send an EKF_STATUS_REPORT message to GCS
|
|
|
|
void send_status_report(mavlink_channel_t chan);
|
|
|
|
|
2015-04-22 23:57:59 -03:00
|
|
|
// provides the height limit to be observed by the control loops
|
|
|
|
// returns false if no height limiting is required
|
|
|
|
// this is needed to ensure the vehicle does not fly too high when using optical flow navigation
|
|
|
|
bool getHeightControlLimit(float &height) const;
|
|
|
|
|
2015-09-22 10:31:32 -03:00
|
|
|
// returns true of the EKF thinks the GPS is glitching
|
|
|
|
bool getGpsGlitchStatus(void) const;
|
|
|
|
|
2015-06-23 04:36:11 -03:00
|
|
|
// return the amount of yaw angle change due to the last yaw angle reset in radians
|
2015-09-24 03:23:20 -03:00
|
|
|
// returns the time of the last yaw angle reset or 0 if no reset has ever occurred
|
2015-10-29 05:31:55 -03:00
|
|
|
uint32_t getLastYawResetAngle(float &yawAng) const;
|
2015-06-23 04:36:11 -03:00
|
|
|
|
2015-10-29 00:10:13 -03:00
|
|
|
// return the amount of NE position change due to the last position reset in metres
|
|
|
|
// returns the time of the last reset or 0 if no reset has ever occurred
|
2015-10-29 05:35:35 -03:00
|
|
|
uint32_t getLastPosNorthEastReset(Vector2f &pos) const;
|
2015-10-29 00:10:13 -03:00
|
|
|
|
|
|
|
// return the amount of NE velocity change due to the last velocity reset in metres/sec
|
|
|
|
// returns the time of the last reset or 0 if no reset has ever occurred
|
2015-10-29 05:35:35 -03:00
|
|
|
uint32_t getLastVelNorthEastReset(Vector2f &vel) const;
|
2015-10-29 00:10:13 -03:00
|
|
|
|
|
|
|
// report any reason for why the backend is refusing to initialise
|
2015-09-08 02:50:39 -03:00
|
|
|
const char *prearm_failure_reason(void) const;
|
|
|
|
|
2014-01-20 01:47:56 -04:00
|
|
|
static const struct AP_Param::GroupInfo var_info[];
|
|
|
|
|
2013-12-29 03:37:55 -04:00
|
|
|
private:
|
2014-01-01 21:15:22 -04:00
|
|
|
const AP_AHRS *_ahrs;
|
2013-12-29 03:37:55 -04:00
|
|
|
AP_Baro &_baro;
|
2015-04-17 06:22:51 -03:00
|
|
|
const RangeFinder &_rng;
|
2015-11-04 19:34:57 -04:00
|
|
|
NavEKF_core *core;
|
2015-10-11 19:50:35 -03:00
|
|
|
|
2014-01-20 06:27:50 -04:00
|
|
|
// EKF Mavlink Tuneable Parameters
|
2015-10-18 20:05:55 -03:00
|
|
|
AP_Int8 _enable; // zero to disable EKF1
|
2014-01-20 06:27:50 -04:00
|
|
|
AP_Float _gpsHorizVelNoise; // GPS horizontal velocity measurement noise : m/s
|
|
|
|
AP_Float _gpsVertVelNoise; // GPS vertical velocity measurement noise : m/s
|
|
|
|
AP_Float _gpsHorizPosNoise; // GPS horizontal position measurement noise m
|
|
|
|
AP_Float _baroAltNoise; // Baro height measurement noise : m^2
|
|
|
|
AP_Float _magNoise; // magnetometer measurement noise : gauss
|
|
|
|
AP_Float _easNoise; // equivalent airspeed measurement noise : m/s
|
|
|
|
AP_Float _windVelProcessNoise; // wind velocity state process noise : m/s^2
|
|
|
|
AP_Float _wndVarHgtRateScale; // scale factor applied to wind process noise due to height rate
|
|
|
|
AP_Float _magEarthProcessNoise; // earth magnetic field process noise : gauss/sec
|
|
|
|
AP_Float _magBodyProcessNoise; // earth magnetic field process noise : gauss/sec
|
|
|
|
AP_Float _gyrNoise; // gyro process noise : rad/s
|
|
|
|
AP_Float _accNoise; // accelerometer process noise : m/s^2
|
|
|
|
AP_Float _gyroBiasProcessNoise; // gyro bias state process noise : rad/s
|
|
|
|
AP_Float _accelBiasProcessNoise;// accel bias state process noise : m/s^2
|
|
|
|
AP_Int16 _msecVelDelay; // effective average delay of GPS velocity measurements rel to IMU (msec)
|
|
|
|
AP_Int16 _msecPosDelay; // effective average delay of GPS position measurements rel to (msec)
|
|
|
|
AP_Int8 _fusionModeGPS; // 0 = use 3D velocity, 1 = use 2D velocity, 2 = use no velocity
|
|
|
|
AP_Int8 _gpsVelInnovGate; // Number of standard deviations applied to GPS velocity innovation consistency check
|
|
|
|
AP_Int8 _gpsPosInnovGate; // Number of standard deviations applied to GPS position innovation consistency check
|
|
|
|
AP_Int8 _hgtInnovGate; // Number of standard deviations applied to height innovation consistency check
|
|
|
|
AP_Int8 _magInnovGate; // Number of standard deviations applied to magnetometer innovation consistency check
|
|
|
|
AP_Int8 _tasInnovGate; // Number of standard deviations applied to true airspeed innovation consistency check
|
2014-04-25 07:32:13 -03:00
|
|
|
AP_Int8 _magCal; // Sets activation condition for in-flight magnetometer calibration
|
2014-03-31 18:15:28 -03:00
|
|
|
AP_Int16 _gpsGlitchAccelMax; // Maximum allowed discrepancy between inertial and GPS Horizontal acceleration before GPS data is ignored : cm/s^2
|
|
|
|
AP_Int8 _gpsGlitchRadiusMax; // Maximum allowed discrepancy between inertial and GPS Horizontal position before GPS glitch is declared : m
|
2014-08-25 04:58:42 -03:00
|
|
|
AP_Int8 _gndGradientSigma; // RMS terrain gradient percentage assumed by the terrain height estimation.
|
|
|
|
AP_Float _flowNoise; // optical flow rate measurement noise
|
|
|
|
AP_Int8 _flowInnovGate; // Number of standard deviations applied to optical flow innovation consistency check
|
|
|
|
AP_Int8 _msecFLowDelay; // effective average delay of optical flow measurements rel to IMU (msec)
|
|
|
|
AP_Int8 _rngInnovGate; // Number of standard deviations applied to range finder innovation consistency check
|
2014-11-10 06:50:49 -04:00
|
|
|
AP_Float _maxFlowRate; // Maximum flow rate magnitude that will be accepted by the filter
|
2014-10-31 21:47:55 -03:00
|
|
|
AP_Int8 _fallback; // EKF-to-DCM fallback strictness. 0 = trust EKF more, 1 = fallback more conservatively.
|
2015-04-05 21:37:59 -03:00
|
|
|
AP_Int8 _altSource; // Primary alt source during optical flow navigation. 0 = use Baro, 1 = use range finder.
|
2015-09-22 10:13:16 -03:00
|
|
|
AP_Int8 _gpsCheck; // Bitmask controlling which preflight GPS checks are bypassed
|
2014-01-29 04:03:07 -04:00
|
|
|
|
2014-01-30 17:47:33 -04:00
|
|
|
};
|