커맨드 구조 분리

2026-06-30 15:42:18 +09:00
parent 9b042dfef2
commit a01c0fb01b
15 changed files with 1492 additions and 1301 deletions
@@ -0,0 +1,123 @@
+/*******************************************************************************
+ * @file    cmd_sensor.c
+ * @brief   BLE command handlers
+ ******************************************************************************/
+#include <zephyr/sys/util.h>
+#include <limits.h>
+
+#include "cmd_common.h"
+#include "main.h"
+#include "debug_print.h"
+#include "battery_adc.h"
+#include "imu_i2c.h"
+#include "led_control.h"
+#include "cmd_sensor.h"
+
+int cmd_msn(const uint8_t *data, uint8_t data_len)
+{
+    ARG_UNUSED(data);
+    ARG_UNUSED(data_len);
+
+    int mv = battery_read_mv();
+    if (mv < 0)
+    {
+        mv = 0;
+    }
+
+    cmd_send_response_u16("rsn:", (uint16_t)mv);
+    return 1;
+}
+
+int cmd_msp(const uint8_t *data, uint8_t data_len)
+{
+    ARG_UNUSED(data);
+    ARG_UNUSED(data_len);
+
+    int16_t accel[3], gyro[3];
+
+    int ret = imu_read(accel, gyro);
+    if (ret != 0)
+    {
+        cmd_send_response_u16("rsp:", 0xFFFF);
+        DBG_PRINTF("[CMD] msp: FAIL (imu_read ret=%d) -> rsp: 0xFFFF\r\n", ret);
+        return 1;
+    }
+
+    cmd_send_response_imu(accel, gyro);
+    return 1;
+}
+
+/* mst? -> IMU internal temperature -> rso: + temperature (degC x 100, BE)
+ * Error response: 0xFFFF = IMU temperature read failed. */
+int cmd_mst(const uint8_t *data, uint8_t data_len)
+{
+    ARG_UNUSED(data);
+    ARG_UNUSED(data_len);
+
+    power_button_suspend(true);
+
+    int16_t t_cdeg = INT16_MIN;
+    int ret = imu_read_temperature_cdeg(&t_cdeg);
+
+    power_button_suspend(false);
+
+    if ((ret != 0) || (t_cdeg == INT16_MIN))
+    {
+        cmd_send_response_u16("rso:", 0xFFFF);
+        DBG_PRINTF("[CMD] mst: imu temp read fail ret=%d\r\n", ret);
+        return 1;
+    }
+
+    /* 음수 온도도 2's complement로 그대로 전송 (앱이 int16로 해석) */
+    cmd_send_response_u16("rso:", (uint16_t)t_cdeg);
+    DBG_PRINTF("[CMD] mst -> %d.%02d C\r\n", t_cdeg / 100, (t_cdeg < 0 ? -t_cdeg : t_cdeg) % 100);
+    return 1;
+}
+
+/*
+ * 테스트용
+ * mpa?: piezo TX/RX 전원 레일만 켬
+ */
+int cmd_mls(const uint8_t *data, uint8_t data_len)
+{
+    /* 파라미터 부족: 에러 코드 0xFFFF 에코 */
+    if (data_len < 2)
+    {
+        cmd_send_response_u16("rls:", 0xFFFF);
+        DBG_PRINTF("[CMD] mls: no data\r\n");
+        return 1;
+    }
+
+    /* state 필드: 2바이트 big-endian */
+    uint16_t state = ((uint16_t)data[0] << 8) | (uint16_t)data[1];
+
+    /* 범위 초과: 에러 코드 0xFFFE 에코 */
+    if (state > LED_STATE_ERROR)
+    {
+        cmd_send_response_u16("rls:", 0xFFFE);
+        DBG_PRINTF("[CMD] mls: invalid state %d\r\n", state);
+        return 1;
+    }
+
+    led_set_state((led_state_t)state);
+
+    /* 정렬 LED 상태와 보호 판정 정책 연결
+     * - ALIGN_SEARCHING/ALIGN_COMPLETE 동안 보호 판정 차단
+     * - 다른 LED 상태에서는 기존 조건에 따라 보호 판정 재개
+     */
+    battery_protection_set_alignment_mode((state == LED_STATE_ALIGN_SEARCHING) ||
+                                          (state == LED_STATE_ALIGN_COMPLETE));
+
+    /* OFF 상태에서는 정렬/측정용 FIFO를 함께 정리 */
+    if (state == LED_STATE_OFF)
+    {
+        (void)imu_fifo_stop();
+    }
+
+    cmd_send_response_u16("rls:", state);
+    return 1;
+}
+
+/*==============================================================================
+ * 커맨드 테이블
+ *============================================================================*/