change initialization order

This commit is contained in:
Alex Mikhalev 2019-04-25 18:27:30 -07:00
parent 3b69f67179
commit a0841cf000

View File

@ -111,9 +111,9 @@ struct State {
ahrs_.begin(1000000.f /
static_cast<float>(LOOP_PERIOD_US)); // rough sample frequency
io->Init();
comms->Init();
display->Init();
io->Init();
esp_timer_create_args_t timer_args;
timer_args.callback = OnTimeout;
@ -135,7 +135,7 @@ struct State {
&m = inputs.mpu.mag;
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 + 50 * 1000) { // 1s
if (time_us >= last_print + 500 * 1000) { // 1s
ESP_LOGD(TAG,
"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,