Rover: added EK2_ parameters and EKF2 instance

This commit is contained in:
Andrew Tridgell 2015-09-21 15:27:49 +10:00
parent f500474a86
commit 5cac948ed0
4 changed files with 9 additions and 1 deletions

View File

@ -521,6 +521,10 @@ const AP_Param::Info Rover::var_info[] PROGMEM = {
// @Group: EKF_
// @Path: ../libraries/AP_NavEKF/AP_NavEKF.cpp
GOBJECTN(EKF, NavEKF, "EKF_", NavEKF),
// @Group: EK2_
// @Path: ../libraries/AP_NavEKF2/AP_NavEKF2.cpp
GOBJECTN(EKF2, NavEKF2, "EK2_", NavEKF2),
#endif
// @Group: MIS_

View File

@ -83,6 +83,7 @@ public:
k_param_steering_learn, // unused
k_param_NavEKF, // Extended Kalman Filter Inertial Navigation Group
k_param_mission, // mission library
k_param_NavEKF2,
// 140: battery controls
k_param_battery_monitoring = 140, // deprecated, can be deleted

View File

@ -42,6 +42,7 @@
#include <AP_InertialSensor/AP_InertialSensor.h> // Inertial Sensor (uncalibated IMU) Library
#include <AP_AHRS/AP_AHRS.h> // ArduPilot Mega DCM Library
#include <AP_NavEKF/AP_NavEKF.h>
#include <AP_NavEKF2/AP_NavEKF2.h>
#include <AP_Mission/AP_Mission.h> // Mission command library
#include <AP_Rally/AP_Rally.h>
#include <AP_Terrain/AP_Terrain.h>
@ -152,7 +153,8 @@ private:
// Inertial Navigation EKF
#if AP_AHRS_NAVEKF_AVAILABLE
NavEKF EKF{&ahrs, barometer, sonar};
AP_AHRS_NavEKF ahrs {ins, barometer, gps, sonar, EKF};
NavEKF2 EKF2{&ahrs, barometer, sonar};
AP_AHRS_NavEKF ahrs {ins, barometer, gps, sonar, EKF, EKF2};
#else
AP_AHRS_DCM ahrs {ins, barometer, gps};
#endif

View File

@ -13,6 +13,7 @@ LIBRARIES += AP_Math
LIBRARIES += AP_InertialSensor
LIBRARIES += AP_AHRS
LIBRARIES += AP_NavEKF
LIBRARIES += AP_NavEKF2
LIBRARIES += AP_Mission
LIBRARIES += AP_Rally
LIBRARIES += AP_Terrain