|
|
@ -75,7 +75,7 @@ struct State { |
|
|
|
&m = inputs.mpu.mag; |
|
|
|
&m = inputs.mpu.mag; |
|
|
|
ahrs_.update(g.x, g.y, g.z, a.x, a.y, a.z, m.x, m.y, m.z); |
|
|
|
ahrs_.update(g.x, g.y, g.z, a.x, a.y, a.z, m.x, m.y, m.z); |
|
|
|
} |
|
|
|
} |
|
|
|
if (time_us >= last_print + 500 * 1000) { // 1s
|
|
|
|
if (time_us >= last_print + 50 * 1000) { // 1s
|
|
|
|
ESP_LOGD(TAG, |
|
|
|
ESP_LOGD(TAG, |
|
|
|
"inputs: acc=(%f, %f, %f) gyro=(%f, %f, %f) mag=(%f, %f, %f)", |
|
|
|
"inputs: acc=(%f, %f, %f) gyro=(%f, %f, %f) mag=(%f, %f, %f)", |
|
|
|
inputs.mpu.accel.x, inputs.mpu.accel.y, inputs.mpu.accel.z, |
|
|
|
inputs.mpu.accel.x, inputs.mpu.accel.y, inputs.mpu.accel.z, |
|
|
|