Create EKF object in right context

src/modules/fw_att_pos_estimator/estimator.cpp

@@ -106,7 +106,16 @@ void swap_var(float &d1, float &d2)
     d2 = tmp;
 }
 
-void  AttPosEKF::UpdateStrapdownEquationsNED()
+AttPosEKF::AttPosEKF()
+{
+
+}
+
+AttPosEKF::~AttPosEKF()
+{
+}
+
+void AttPosEKF::UpdateStrapdownEquationsNED()
 {
     Vector3f delVelNav;
     float q00;

src/modules/fw_att_pos_estimator/estimator.h

@@ -78,6 +78,10 @@ struct ekf_status_report {
 class AttPosEKF {
 
 public:
+
+    AttPosEKF();
+    ~AttPosEKF();
+
     // Global variables
     float KH[n_states][n_states]; //  intermediate result used for covariance updates
     float KHP[n_states][n_states]; // intermediate result used for covariance updates

src/modules/fw_att_pos_estimator/fw_att_pos_estimator_main.cpp

@@ -292,7 +292,7 @@ FixedwingEstimator::FixedwingEstimator() :
 	_initialized(false),
 	_gps_initialized(false),
 	_mavlink_fd(-1),
-	_ekf(new AttPosEKF())
+	_ekf(nullptr)
 {
 
 	_mavlink_fd = open(MAVLINK_LOG_DEVICE, 0);
@@ -396,6 +396,8 @@ void
 FixedwingEstimator::task_main()
 {
 
+	_ekf = new AttPosEKF();
+
 	if (!_ekf) {
 		errx(1, "failed allocating EKF filter - out of RAM!");
 	}