mc_att_control: copy sensor_correction topic once initially

Signed-off-by: Roman <bapstroman@gmail.com>

Author: RomanBapst

src/modules/mc_att_control/mc_att_control_main.cpp

@@ -613,6 +613,14 @@ MulticopterAttitudeControl::run()
 }
 
 _sensor_correction_sub = orb_subscribe(ORB_ID(sensor_correction));
+
+// sensor correction topic is not being published regularly and we might have missed the first update.
+// so copy it once initially so that we have the latest data. In future this will not be needed anymore as the
+// behavior of the orb_check function will change
+if (_sensor_correction_sub > 0) {
+orb_copy(ORB_ID(sensor_correction), _sensor_correction_sub, &_sensor_correction);
+}
+
 _sensor_bias_sub = orb_subscribe(ORB_ID(sensor_bias));
 
 /* wakeup source: gyro data from sensor selected by the sensor app */