mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-15 20:13:35 +08:00
Use current rotation matrix for vision instead of delayed rotation
This commit is contained in:
@@ -912,7 +912,7 @@ int position_estimator_inav_thread_main(int argc, char *argv[])
|
||||
float c = 0.0f;
|
||||
|
||||
for (int j = 0; j < 3; j++) {
|
||||
c += R_gps[j][i] * accel_bias_corr[j];
|
||||
c += att.R[j][i] * accel_bias_corr[j];
|
||||
}
|
||||
|
||||
if (isfinite(c)) {
|
||||
|
||||
Reference in New Issue
Block a user