|
|
|
@ -64,7 +64,7 @@ public:
@@ -64,7 +64,7 @@ public:
|
|
|
|
|
Compass compass = Compass::create(); |
|
|
|
|
AP_SerialManager serial_manager = AP_SerialManager::create(); |
|
|
|
|
RangeFinder rng = RangeFinder::create(serial_manager, ROTATION_PITCH_270); |
|
|
|
|
NavEKF2 EKF2{&ahrs, barometer, rng}; |
|
|
|
|
NavEKF2 EKF2 = NavEKF2::create(&ahrs, barometer, rng); |
|
|
|
|
NavEKF3 EKF3{&ahrs, barometer, rng}; |
|
|
|
|
AP_AHRS_NavEKF ahrs {ins, barometer, gps, EKF2, EKF3}; |
|
|
|
|
AP_InertialNav_NavEKF inertial_nav{ahrs}; |
|
|
|
|