forked from Archive/PX4-Autopilot
Use current rotation matrix for vision instead of delayed rotation
This commit is contained in:
parent
38d3efa985
commit
25ef4bc4a0
|
@ -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)) {
|
||||
|
|
Loading…
Reference in New Issue