yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-22 01:12:31 +00:00
Code Issues Packages Projects Releases Wiki Activity

attitude_estimator_q: cleanup output, remove unnecessary topic init

Browse Source
This commit is contained in:
Beat Küng
2018-07-23 09:12:28 +02:00
committed by Lorenz Meier
parent 97fe5f928a
commit f4fef5efc8
1 changed files with 3 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
src/modules/attitude_estimator_q/attitude_estimator_q_main.cpp
View File

@@ -311,7 +311,7 @@ void AttitudeEstimatorQ::task_main()
_accel(2) = sensors.accelerometer_m_s2[2];
if (_accel.length() < 0.01f) {
PX4_ERR("WARNING: degenerate accel!");
PX4_ERR("degenerate accel!");
continue;
}
}
@@ -324,7 +324,7 @@ void AttitudeEstimatorQ::task_main()
orb_check(_magnetometer_sub, &magnetometer_updated);
if (magnetometer_updated) {
vehicle_magnetometer_s magnetometer = {};
vehicle_magnetometer_s magnetometer;
if (orb_copy(ORB_ID(vehicle_magnetometer), _magnetometer_sub, &magnetometer) == PX4_OK) {
_mag(0) = magnetometer.magnetometer_ga[0];
@@ -332,7 +332,7 @@ void AttitudeEstimatorQ::task_main()
_mag(2) = magnetometer.magnetometer_ga[2];
if (_mag.length() < 0.01f) {
PX4_ERR("WARNING: degenerate mag!");
PX4_ERR("degenerate mag!");
continue;
}
}