inholland/ros2-assignments
3
1
Fork 0
generated from wessel/boilerplate
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

fix(serial): Exchange ESP_LOGI for printf, up cycletime to 500ms

Browse Source
This commit is contained in:
Vincent Kompjoeteraar Winter
2025-10-29 20:32:28 +01:00
committed by Wessel T
parent 8199115422
commit fe5e37c231
1 changed files with 11 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

15
IMU/main/mpu6886.c
View File

@@ -276,14 +276,21 @@ void app_main(void)
mpu6886_read_accel(&mpu, &accel); mpu6886_read_accel(&mpu, &accel);
mpu6886_read_gyro(&mpu, &gyro); mpu6886_read_gyro(&mpu, &gyro);
mpu6886_read_temp(&mpu, &temp); mpu6886_read_temp(&mpu, &temp);
ESP_LOGI("MPU6886", "Accel: X=%8.2f Y=%8.2f Z=%8.2f m/s² | Gyro: X=%8.2f Y=%8.2f Z=%8.2f rad/s | Temp: %8.2f °C", // ESP_LOGI("MPU6886", "Accel: X=%8.2f Y=%8.2f Z=%8.2f m/s² | Gyro: X=%8.2f Y=%8.2f Z=%8.2f rad/s | Temp: %8.2f °C",
accel.x, accel.y, accel.z, gyro.x, gyro.y, gyro.z, temp); // accel.x, accel.y, accel.z, gyro.x, gyro.y, gyro.z, temp);
// printf("aX=%8.2f aY=%8.2f aZ=%8.2f m/s² | gX=%8.2f gY=%8.2f gZ=%8.2f rad/s | Temp: %8.2f °C\n",
// accel.x, accel.y, accel.z, gyro.x, gyro.y, gyro.z, temp);
printf("{\"accel\":{\"aX\":%8.3f,\"aY\":%8.3f,\"aZ\":%8.3f},\"gyro\":{\"gX\":%8.3f,\"gY\":%8.3f,\"gZ\":%8.3f},\"Temp\":%8.2f}",
accel.x, accel.y, accel.z,
gyro.x, gyro.y, gyro.z,
temp);
// Publish readings as JSON over MQTT if client available // Publish readings as JSON over MQTT if client available
if (s_mqtt_client != NULL) { if (s_mqtt_client != NULL) {
char payload[256]; char payload[256];
int n = snprintf(payload, sizeof(payload), int n = snprintf(payload, sizeof(payload),
"{\"accel\":{\"x\":%.3f,\"y\":%.3f,\"z\":%.3f},\"gyro\":{\"x\":%.3f,\"y\":%.3f,\"z\":%.3f},\"temp\":%.2f}", "{\"accel\":{\"aX\":%8.3f,\"aY\":%8.3f,\"aZ\":%8.3f},\"gyro\":{\"gX\":%8.3f,\"gY\":%8.3f,\"gZ\":%8.3f},\"Temp\":%8.2f}",
accel.x, accel.y, accel.z, accel.x, accel.y, accel.z,
gyro.x, gyro.y, gyro.z, gyro.x, gyro.y, gyro.z,
temp); temp);
@@ -294,6 +301,6 @@ void app_main(void)
ESP_LOGW("MQTT", "payload truncated or encoding error"); ESP_LOGW("MQTT", "payload truncated or encoding error");
} }
} }
vTaskDelay(pdMS_TO_TICKS(100)); vTaskDelay(pdMS_TO_TICKS(500));
} }
} }