初版

SDK/apps/watch/test/rssi.c

@@ -0,0 +1,82 @@
+#ifdef SUPPORT_MS_EXTENSIONS
+#pragma bss_seg(".rssi.data.bss")
+#pragma data_seg(".rssi.data")
+#pragma const_seg(".rssi.text.const")
+#pragma code_seg(".rssi.text")
+#endif
+#include "btstack/avctp_user.h"
+#include "app_config.h"
+#include "bt_tws.h"
+#include "app_main.h"
+
+
+#if TCFG_USER_RSSI_TEST_EN
+
+
+static void spp_send_rssi(int slave_rssi)
+{
+    u8 send_buf[8];
+
+    send_buf[0] = 0xfe;
+    send_buf[1] = 0xdc;
+    send_buf[2] = 0x04;
+    send_buf[3] = 0x02;
+    if (tws_api_get_local_channel() == 'L') {
+        get_rssi_api((char *)&send_buf[4], (char *)&send_buf[6]);
+        send_buf[5] = (s8)slave_rssi;
+    } else {
+        get_rssi_api((char *)&send_buf[5], (char *)&send_buf[6]);
+        send_buf[4] = (s8)slave_rssi;
+    }
+    send_buf[7] = 0xba;
+    bt_cmd_prepare(USER_CTRL_SPP_SEND_DATA, sizeof(send_buf), send_buf);
+    /* put_buf(send_buf, sizeof(send_buf)); */
+    /* printf("get rssi, l:%d, r:%d, tws:%d", send_buf[4], send_buf[5], send_buf[6]); */
+}
+
+static void app_core_send_rssi(int slave_rssi)
+{
+    int msg[3];
+
+    msg[0] = (int)spp_send_rssi;
+    msg[1] = 1;
+    msg[2] = slave_rssi;
+    os_taskq_post_type("app_core", Q_CALLBACK, 3, msg);
+}
+
+#define TWS_FUNC_ID_RSSI_SYNC	TWS_FUNC_ID('R', 'S', 'S', 'I')
+
+static void tws_get_rssi_handler(void *_data, u16 len, bool rx)
+{
+    u8 *data = (u8 *)_data;
+
+    if (rx) {
+        app_core_send_rssi(data[0]);
+    }
+}
+
+REGISTER_TWS_FUNC_STUB(tws_get_rssi) = {
+    .func_id = TWS_FUNC_ID_RSSI_SYNC,
+    .func    = tws_get_rssi_handler,
+};
+
+int spp_get_rssi_handler(u8 *packet, u16 size)
+{
+    const u8 get_rssi_cmd[] = {0xfe, 0xdc, 0x01, 0x01, 0xba};
+    u8 send_cmd_buffer[2];
+    if (packet != NULL && size == sizeof(get_rssi_cmd) && !memcmp(packet, get_rssi_cmd, size)) {
+        if (tws_api_get_tws_state() & TWS_STA_SIBLING_CONNECTED) {
+            if (tws_api_get_role() == TWS_ROLE_SLAVE) {
+                get_rssi_api((char *)&send_cmd_buffer[0], (char *)&send_cmd_buffer[1]);
+                tws_api_send_data_to_sibling(send_cmd_buffer, sizeof(send_cmd_buffer),
+                                             TWS_FUNC_ID_RSSI_SYNC);
+            }
+        } else {
+            app_core_send_rssi(-127);
+        }
+        return 1;
+    }
+    return 0;
+}
+
+#endif