huxi
83 lines
2.2 KiB
C
83 lines
2.2 KiB
C
#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
|