디버그 로그 통일(UART -> RTT)
- app_raw.c: printf() -> DBG_PRINTF(RTT) - 전력 소모 방지: CPU 문자열 포맷팅 실행 제거
This commit is contained in:
@@ -119,20 +119,20 @@ int setup_imu_device(struct inv_imu_serif *icm_serif)
|
|||||||
/* IMU 드라이버 초기화 — 시리얼 인터페이스 연결 및 콜백 함수 등록 */
|
/* IMU 드라이버 초기화 — 시리얼 인터페이스 연결 및 콜백 함수 등록 */
|
||||||
rc = inv_imu_init(&icm_driver, icm_serif, imu_callback);
|
rc = inv_imu_init(&icm_driver, icm_serif, imu_callback);
|
||||||
if (rc != INV_ERROR_SUCCESS) {
|
if (rc != INV_ERROR_SUCCESS) {
|
||||||
printf("!!! ERROR : Failed to initialize IMU!\r\n");
|
DBG_PRINTF("!!! ERROR : Failed to initialize IMU!\r\n");
|
||||||
return rc;
|
return rc;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* WHOAMI 레지스터 읽기 — 디바이스 존재 및 통신 확인 */
|
/* WHOAMI 레지스터 읽기 — 디바이스 존재 및 통신 확인 */
|
||||||
rc = inv_imu_get_who_am_i(&icm_driver, &who_am_i);
|
rc = inv_imu_get_who_am_i(&icm_driver, &who_am_i);
|
||||||
if (rc != INV_ERROR_SUCCESS) {
|
if (rc != INV_ERROR_SUCCESS) {
|
||||||
printf("!!! ERROR : Failed to read whoami!\r\n");
|
DBG_PRINTF("!!! ERROR : Failed to read whoami!\r\n");
|
||||||
return rc;
|
return rc;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* WHOAMI 값 검증 — ICM42670P의 경우 0x67이어야 함 */
|
/* WHOAMI 값 검증 — ICM42670P의 경우 0x67이어야 함 */
|
||||||
if (who_am_i != ICM_WHOAMI) {
|
if (who_am_i != ICM_WHOAMI) {
|
||||||
printf("!!! ERROR : Bad WHOAMI value! Read 0x%02x, expected 0x%02x\r\n", who_am_i, ICM_WHOAMI);
|
DBG_PRINTF("!!! ERROR : Bad WHOAMI value! Read 0x%02x, expected 0x%02x\r\n", who_am_i, ICM_WHOAMI);
|
||||||
return INV_ERROR;
|
return INV_ERROR;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -354,7 +354,7 @@ void imu_callback(inv_imu_sensor_event_t *event)
|
|||||||
* 스케일링된 데이터를 UART로 출력
|
* 스케일링된 데이터를 UART로 출력
|
||||||
*/
|
*/
|
||||||
if (event->sensor_mask & (1 << INV_SENSOR_ACCEL) && event->sensor_mask & (1 << INV_SENSOR_GYRO))
|
if (event->sensor_mask & (1 << INV_SENSOR_ACCEL) && event->sensor_mask & (1 << INV_SENSOR_GYRO))
|
||||||
printf("%u: %.3f, \t%.3f, \t%.3f, \t%.3f, \t%.3f, \t%.3f, \t%.3f\r\n",
|
DBG_PRINTF("%u: %.3f, \t%.3f, \t%.3f, \t%.3f, \t%.3f, \t%.3f, \t%.3f\r\n",
|
||||||
(uint32_t)timestamp,
|
(uint32_t)timestamp,
|
||||||
accel_g[0], accel_g[1], accel_g[2],
|
accel_g[0], accel_g[1], accel_g[2],
|
||||||
temp_degc,
|
temp_degc,
|
||||||
@@ -381,7 +381,7 @@ void imu_callback(inv_imu_sensor_event_t *event)
|
|||||||
|
|
||||||
/* UART 모드: "Tp" 접두사로 6축 데이터를 텍스트 형식으로 출력 */
|
/* UART 모드: "Tp" 접두사로 6축 데이터를 텍스트 형식으로 출력 */
|
||||||
else if(cmd_type_t == CMD_UART) {
|
else if(cmd_type_t == CMD_UART) {
|
||||||
printf("Tp%d,%d,%d,%d,%d,%d\r\n\r\n", accel[0], accel[1], accel[2], gyro[0], gyro[1], gyro[2]);
|
DBG_PRINTF("Tp%d,%d,%d,%d,%d,%d\r\n\r\n", accel[0], accel[1], accel[2], gyro[0], gyro[1], gyro[2]);
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
@@ -399,7 +399,7 @@ void imu_callback(inv_imu_sensor_event_t *event)
|
|||||||
ssp_data[5] = (uint16_t)gyro[2];
|
ssp_data[5] = (uint16_t)gyro[2];
|
||||||
|
|
||||||
format_data(imu_bin_buffer, "rsp:", ssp_data,12);
|
format_data(imu_bin_buffer, "rsp:", ssp_data,12);
|
||||||
printf("Tp%d,%d,%d,%d,%d,%d\r\n\r\n", accel[0], accel[1], accel[2], gyro[0], gyro[1], gyro[2]);
|
DBG_PRINTF("Tp%d,%d,%d,%d,%d,%d\r\n\r\n", accel[0], accel[1], accel[2], gyro[0], gyro[1], gyro[2]);
|
||||||
dr_binary_tx_safe(imu_bin_buffer,8);
|
dr_binary_tx_safe(imu_bin_buffer,8);
|
||||||
|
|
||||||
if(custom_add_data==true) {
|
if(custom_add_data==true) {
|
||||||
|
|||||||
Reference in New Issue
Block a user