lmx/99_7018_lmx
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
Files
7567ddc0883a6fb596606ff9e0c818cf5300ca3b
99_7018_lmx/apps/earphone/bt_tws.c

2229 lines
63 KiB
C
Raw Normal View History

first
2025-10-29 13:10:02 +08:00
#include "system/includes.h"
#include "media/includes.h"
#include "device/vm.h"
#include "tone_player.h"
#include "app_config.h"
#include "app_action.h"
#include "earphone.h"
#include "btstack/avctp_user.h"
#include "btstack/btstack_task.h"
#include "classic/hci_lmp.h"
#include "user_cfg.h"
#if TCFG_USER_TWS_ENABLE
#include "bt_tws.h"
#endif
#include "asm/charge.h"
#include "app_charge.h"
#include "ui_manage.h"
#include "app_chargestore.h"
#include "app_testbox.h"
#include "app_online_cfg.h"
#include "app_main.h"
#include "app_power_manage.h"
#include "audio_config.h"
#include "user_cfg.h"
#include "btcontroller_config.h"
#include "bt_common.h"
#include "asm/pwm_led.h"
#include "bt_common.h"
#include "pbg_user.h"
#if (TCFG_BLE_DEMO_SELECT == DEF_BLE_DEMO_ADV)
#include "include/bt_ble.h"
#endif
#if TCFG_AUDIO_ANC_ENABLE
#include "audio_anc.h"
#endif
#if TCFG_ANC_BOX_ENABLE
#include "app_ancbox.h"
#endif
#if TCFG_AUDIO_ANC_ACOUSTIC_DETECTOR_EN
#include "icsd_adt_app.h"
#endif /*TCFG_AUDIO_ANC_ACOUSTIC_DETECTOR_EN*/
#if TCFG_USER_TWS_ENABLE
#define LOG_TAG_CONST BT_TWS
#define LOG_TAG "[BT-TWS]"
#define LOG_ERROR_ENABLE
#define LOG_DEBUG_ENABLE
#define LOG_INFO_ENABLE
/* #define LOG_DUMP_ENABLE */
#define LOG_CLI_ENABLE
#include "debug.h"
#if TCFG_DEC2TWS_ENABLE
#define CONFIG_BT_TWS_SNIFF 0 //[WIP]
#else
#define CONFIG_BT_TWS_SNIFF 1 //[WIP]
#endif
#define BT_TWS_UNPAIRED 0x0001
#define BT_TWS_PAIRED 0x0002
#define BT_TWS_WAIT_SIBLING_SEARCH 0x0004
#define BT_TWS_SEARCH_SIBLING 0x0008
#define BT_TWS_CONNECT_SIBLING 0x0010
#define BT_TWS_SIBLING_CONNECTED 0x0020
#define BT_TWS_PHONE_CONNECTED 0x0040
#define BT_TWS_POWER_ON 0x0080
#define BT_TWS_TIMEOUT 0x0100
#define BT_TWS_AUDIO_PLAYING 0x0200
#define BT_TWS_DISCON_DLY_TIMEOUT 0x0400
#define BT_TWS_REMOVE_PAIRS 0x0800
#define BT_TWS_DISCON_DLY_TIMEOUT_NO_CONN 0x1000
#define TWS_DLY_DISCONN_TIME 2000//超时断开，快速连接上不播提示音
struct tws_user_var {
u8 addr[6];
u16 state;
s16 auto_pair_timeout;
int pair_timer;
u32 connect_time;
u8 device_role; //tws 记录那个是active device 活动设备，音源控制端
u16 tws_dly_discon_time;
u16 sniff_timer;
};
struct tws_user_var gtws;
extern void tone_play_deal(const char *name, u8 preemption, u8 add_en);
extern u8 check_tws_le_aa(void);
extern const char *bt_get_local_name();
extern u8 get_bredr_link_state();
extern u8 get_esco_coder_busy_flag();
void bt_init_ok_search_index(void);
extern void phone_num_play_timer(void *priv);
extern u8 phone_ring_play_start(void);
extern bool get_esco_busy_flag();
extern void tws_api_set_connect_aa(int);
extern void tws_api_clear_connect_aa();
extern u8 tws_remote_state_check(void);
extern void tws_remote_state_clear(void);
extern u16 bt_get_tws_device_indicate(u8 *tws_device_indicate);
void tws_le_acc_generation_init(void);
static void bt_tws_connect_and_connectable_switch();
extern int earphone_a2dp_codec_get_low_latency_mode();
extern int earphone_a2dp_codec_set_low_latency_mode(int enable, int);
extern u32 get_bt_slot_time(u8 type, u32 time, int *ret_time, int (*local_us_time)(void));
extern u32 get_sync_rec_instant_us_time();
extern int update_check_sniff_en(void);
void tws_sniff_controle_check_disable(void);
static u32 local_us_time = 0;
static u32 local_instant_us_time = 0;
static u8 tone_together_by_systime = 0;
static u32 tws_tone_together_time = 0;
void tws_sniff_controle_check_enable(void);
u8 tws_network_audio_was_started(void)
{
if (gtws.state & BT_TWS_AUDIO_PLAYING) {
return 1;
}
return 0;
}
void tws_network_local_audio_start(void)
{
gtws.state &= ~BT_TWS_AUDIO_PLAYING;
}
static void tws_sync_call_fun(int cmd, int err)
{
struct sys_event event;
int diff_time_us = 0;
event.type = SYS_BT_EVENT;
event.arg = (void *)SYS_BT_EVENT_FROM_TWS;
event.u.bt.event = TWS_EVENT_SYNC_FUN_CMD;
event.u.bt.args[0] = 0;
event.u.bt.args[1] = 0;
event.u.bt.args[2] = cmd;
sys_event_notify(&event);
}
TWS_SYNC_CALL_REGISTER(tws_tone_sync) = {
.uuid = 'T',
.func = tws_sync_call_fun,
};
u8 tws_tone_together_without_bt(void)
{
return tone_together_by_systime;
}
void tws_tone_together_clean(void)
{
tone_together_by_systime = 0;
}
u32 tws_tone_local_together_time(void)
{
return tws_tone_together_time;
}
u32 get_local_us_time(u32 *instant_time)
{
*instant_time = local_instant_us_time;
return local_us_time;
}
#define msecs_to_bt_slot_clk(m) (((m + 1)* 1000) / 625)
u32 bt_tws_master_slot_clk(void);
u32 bt_tws_future_slot_time(u32 msecs)
{
return bt_tws_master_slot_clk() + msecs_to_bt_slot_clk(msecs);
}
u16 tws_host_get_battery_voltage()
{
return get_vbat_level();
}
int tws_host_channel_match(char remote_channel)
{
/*r_printf("tws_host_channel_match: %c, %c\n", remote_channel,
bt_tws_get_local_channel());*/
#ifdef CONFIG_NEW_BREDR_ENABLE
#if CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_LEFT_START_PAIR || \
CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_RIGHT_START_PAIR || \
CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_MASTER_AS_LEFT || \
CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_SECECT_BY_CHARGESTORE
return 1;
#else
if (remote_channel != bt_tws_get_local_channel()) {
return 1;
}
#endif
#else
#if (CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_MASTER_AS_LEFT)
return 1;
#endif
if (remote_channel != bt_tws_get_local_channel() || remote_channel == 'U') {
return 1;
}
#if CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_LEFT_START_PAIR || \
CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_RIGHT_START_PAIR
if (gtws.state & BT_TWS_SEARCH_SIBLING) {
return 1;
}
#endif
#endif
return 0;
}
char tws_host_get_local_channel()
{
char channel;
#if (CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_RIGHT_START_PAIR)
if (gtws.state & BT_TWS_SEARCH_SIBLING) {
return 'R';
}
#elif (CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_LEFT_START_PAIR)
if (gtws.state & BT_TWS_SEARCH_SIBLING) {
return 'L';
}
#endif
channel = bt_tws_get_local_channel();
if (channel != 'R') {
channel = 'L';
}
/*y_printf("tws_host_get_local_channel: %c\n", channel);*/
return channel;
}
#if CONFIG_TWS_COMMON_ADDR_SELECT == CONFIG_TWS_COMMON_ADDR_USED_LEFT
#ifdef CONFIG_NEW_BREDR_ENABLE
void tws_host_get_common_addr(u8 *remote_mac_addr, u8 *common_addr, char channel)
{
if (channel == 'L') {
memcpy(common_addr, bt_get_mac_addr(), 6);
} else {
memcpy(common_addr, remote_mac_addr, 6);
}
}
#endif
#endif
#if TCFG_DEC2TWS_ENABLE
int tws_host_get_local_role()
{
if (app_var.have_mass_storage) {
return TWS_ROLE_MASTER;
}
return TWS_ROLE_SLAVE;
}
#endif
/*
* 设置自动回连的识别码 6个byte
* */
u8 auto_pair_code[6] = {0x34, 0x66, 0x33, 0x87, 0x09, 0x42};
u8 *tws_set_auto_pair_code(void)
{
u16 code = bt_get_tws_device_indicate(NULL);
auto_pair_code[0] = code >> 8;
auto_pair_code[1] = code & 0xff;
return auto_pair_code;
}
#if CONFIG_TWS_PAIR_MODE == CONFIG_TWS_PAIR_BY_FAST_CONN
u8 tws_auto_pair_enable = 1;
#else
u8 tws_auto_pair_enable = 0;
#endif
u8 tws_get_sibling_addr(u8 *addr, int *result)
{
u8 all_ff[6] = {0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF};
int len = syscfg_read(CFG_TWS_REMOTE_ADDR, addr, 6);
if (len != 6 || !memcmp(addr, all_ff, 6)) {
*result = len;
return -ENOENT;
}
return 0;
}
void lmp_hci_write_local_address(const u8 *addr);
/*
* 获取左右耳信息
* 'L': 左耳
* 'R': 右耳
* 'U': 未知
*/
char bt_tws_get_local_channel()
{
char channel = 'U';
syscfg_read(CFG_TWS_CHANNEL, &channel, 1);
return channel;
}
int get_bt_tws_connect_status()
{
if (gtws.state & BT_TWS_SIBLING_CONNECTED) {
return 1;
}
return 0;
}
u8 get_bt_tws_discon_dly_state()
{
if (gtws.tws_dly_discon_time) {
return 1;
}
return 0;
}
void tws_disconn_dly_deal(void *priv)
{
int role = (int)priv;
r_printf("tws_disconn_dly_deal=0x%x\n", role);
STATUS *p_tone = get_tone_config();
gtws.tws_dly_discon_time = 0;
if (gtws.state & BT_TWS_DISCON_DLY_TIMEOUT) {
tone_play_index(p_tone->tws_disconnect, 1);
}
if ((gtws.state & BT_TWS_DISCON_DLY_TIMEOUT_NO_CONN) && (role == TWS_ROLE_SLAVE) && (!app_var.goto_poweroff_flag)) { /*关机不播断开提示音*/
tone_play_index(p_tone->bt_disconnect, 1);
}
gtws.state &= ~BT_TWS_DISCON_DLY_TIMEOUT_NO_CONN;
}
void tws_sync_phone_num_play_wait(void *priv)
{
puts("tws_sync_phone_num_play_wait\n");
if (bt_user_priv_var.phone_con_sync_num_ring) {
puts("phone_con_sync_num_ring\n");
return;
}
if (bt_user_priv_var.phone_num_flag) {
if (tws_api_get_role() == TWS_ROLE_SLAVE) {
bt_tws_play_tone_at_same_time(SYNC_TONE_PHONE_NUM, 400);
} else { //从机超时还没获取到
phone_ring_play_start();
}
} else {
/*电话号码还没有获取到，定时查询*/
if (bt_user_priv_var.get_phone_num_timecnt > 60) {
bt_user_priv_var.get_phone_num_timecnt = 0;
bt_tws_play_tone_at_same_time(SYNC_TONE_PHONE_NUM_RING, 400);
} else {
bt_user_priv_var.phone_timer_id = sys_timeout_add(NULL, tws_sync_phone_num_play_wait, 10);
}
}
bt_user_priv_var.get_phone_num_timecnt++;
}
int bt_tws_sync_phone_num(void *priv)
{
int state = tws_api_get_tws_state();
if ((state & TWS_STA_SIBLING_CONNECTED) && (state & TWS_STA_PHONE_CONNECTED)) {
puts("bt_tws_sync_phone_num\n");
#if BT_PHONE_NUMBER
bt_user_priv_var.get_phone_num_timecnt = 0;
if (tws_api_get_role() == TWS_ROLE_SLAVE && bt_user_priv_var.phone_con_sync_num_ring) { //从机同步播来电ring,不在发起sync_play
puts("phone_con_sync_num_ring_ing return\n");
return 1;
}
#endif
if (tws_api_get_role() == TWS_ROLE_SLAVE || bt_user_priv_var.phone_con_sync_num_ring) {
if (!(state & TWS_STA_MONITOR_START)) {
puts(" not monitor ring_tone\n");
/* tws_api_sync_call_by_uuid('T', SYNC_CMD_PHONE_RING_TONE, TWS_SYNC_TIME_DO * 5); */
bt_user_priv_var.phone_timer_id = sys_timeout_add(NULL, (void (*)(void *priv))bt_tws_sync_phone_num, 10);
return 1;
}
#if BT_PHONE_NUMBER
if (bt_user_priv_var.phone_con_sync_num_ring) {
puts("<<<<<<<<<<<send_SYNC_CMD_PHONE_SYNC_NUM_RING_TONE\n");
bt_tws_play_tone_at_same_time(SYNC_TONE_PHONE_NUM_RING, 400);
} else {
bt_user_priv_var.phone_timer_id = sys_timeout_add(NULL, tws_sync_phone_num_play_wait, 10);
}
#else
bt_tws_play_tone_at_same_time(SYNC_TONE_PHONE_RING, 600);
#endif
} else {
#if BT_PHONE_NUMBER
if (!bt_user_priv_var.phone_timer_id) { //从机超时还没获取到
/* bt_user_priv_var.phone_timer_id = sys_timeout_add(NULL, tws_sync_phone_num_play_wait, TWS_SYNC_TIME_DO * 2); */
}
#endif
}
return 1;
}
return 0;
}
static void bt_tws_delete_pair_timer()
{
if (gtws.pair_timer) {
sys_timeout_del(gtws.pair_timer);
gtws.pair_timer = 0;
}
}
/*
* 根据配对码搜索TWS设备
* 搜索超时会收到事件: TWS_EVENT_SEARCH_TIMEOUT
* 搜索到连接超时会收到事件: TWS_EVENT_CONNECTION_TIMEOUT
* 搜索到并连接成功会收到事件: TWS_EVENT_CONNECTED
*/
static void bt_tws_search_sibling_and_pair()
{
u8 mac_addr[6];
bt_tws_delete_pair_timer();
tws_api_get_local_addr(gtws.addr);
#if CONFIG_TWS_PAIR_MODE == CONFIG_TWS_PAIR_BY_CLICK
get_random_number(mac_addr, 6);
lmp_hci_write_local_address(mac_addr);
#endif
tws_api_search_sibling_by_code(bt_get_tws_device_indicate(NULL), 15000);
}
/*
*打开可发现, 可连接，可被手机和tws搜索到
*/
static void bt_tws_wait_pair_and_phone_connect()
{
bt_tws_delete_pair_timer();
tws_api_wait_pair_by_code(bt_get_tws_device_indicate(NULL), bt_get_local_name(), 0);
}
static void bt_tws_wait_sibling_connect(int timeout)
{
bt_tws_delete_pair_timer();
tws_api_wait_connection(timeout);
}
static void bt_tws_connect_sibling(int timeout)
{
int err;
bt_tws_delete_pair_timer();
err = tws_api_create_connection(timeout * 1000);
if (err) {
bt_tws_connect_and_connectable_switch();
}
}
static int bt_tws_connect_phone()
{
int timeout = 6500;
bt_user_priv_var.auto_connection_counter -= timeout ;
tws_api_cancle_wait_pair();
tws_api_cancle_create_connection();
user_send_cmd_prepare(USER_CTRL_START_CONNEC_VIA_ADDR, 6,
bt_user_priv_var.auto_connection_addr);
return timeout;
}
/*
* TWS 回连手机、开可发现可连接、回连已配对设备、搜索tws设备 4个状态间定时切换函数
*
*/
#ifdef CONFIG_NEW_BREDR_ENABLE
static void connect_and_connectable_switch(void *_sw)
{
int timeout = 0;
int sw = (int)_sw;
int end_sw = 1;
gtws.pair_timer = 0;
log_info("switch: %d, state = %x, %d\n", sw, gtws.state,
bt_user_priv_var.auto_connection_counter);
if (sw == 0) {
__again:
if (bt_user_priv_var.auto_connection_counter > 0) {
if (gtws.state & BT_TWS_SIBLING_CONNECTED) {
timeout = 8000;
} else {
#ifdef CONFIG_TWS_BY_CLICK_PAIR_WITHOUT_PAIR
timeout = 2000 + (rand32() % 4 + 1) * 500;
#else
timeout = 4000 + (rand32() % 4 + 1) * 500;
#endif
}
bt_user_priv_var.auto_connection_counter -= timeout ;
tws_api_cancle_wait_pair();
tws_api_cancle_create_connection();
user_send_cmd_prepare(USER_CTRL_START_CONNEC_VIA_ADDR, 6,
bt_user_priv_var.auto_connection_addr);
} else {
bt_user_priv_var.auto_connection_counter = 0;
EARPHONE_STATE_CANCEL_PAGE_SCAN();
if (gtws.state & BT_TWS_POWER_ON) {
/*
* 开机回连,获取下一个设备地址
*/
if (get_current_poweron_memory_search_index(NULL)) {
bt_init_ok_search_index();
goto __again;
}
gtws.state &= ~BT_TWS_POWER_ON;
}
if (gtws.state & BT_TWS_SIBLING_CONNECTED) {
tws_api_wait_pair_by_code(bt_get_tws_device_indicate(NULL), bt_get_local_name(), 0);
tws_sniff_controle_check_enable();
return;
}
#if CONFIG_TWS_PAIR_MODE == CONFIG_TWS_PAIR_BY_CLICK
if (gtws.state & BT_TWS_UNPAIRED) {
tws_api_wait_pair_by_code(bt_get_tws_device_indicate(NULL), bt_get_local_name(), 0);
return;
}
#endif
sw = 1;
}
}
if (sw == 1) {
tws_api_wait_pair_by_code(bt_get_tws_device_indicate(NULL), bt_get_local_name(), 0);
if (!(gtws.state & BT_TWS_SIBLING_CONNECTED)) {
if (!(gtws.state & BT_TWS_UNPAIRED)) {
#ifdef CONFIG_TWS_AUTO_PAIR_WITHOUT_UNPAIR
end_sw = 2;
#endif
} else {
#if CONFIG_TWS_PAIR_MODE == CONFIG_TWS_PAIR_BY_CLICK
goto __set_time;
#endif
}
tws_api_create_connection(0);
//tws_api_power_saving_mode_enable();
}
__set_time:
#ifdef CONFIG_TWS_BY_CLICK_PAIR_WITHOUT_PAIR
timeout = 500 + (rand32() % 4 + 1) * 500;
#else
timeout = 2000 + (rand32() % 4 + 1) * 500;
#endif
EARPHONE_STATE_SET_PAGE_SCAN_ENABLE();
if (bt_user_priv_var.auto_connection_counter <= 0 && end_sw == 1) {
if (gtws.state & BT_TWS_SIBLING_CONNECTED) {
tws_sniff_controle_check_enable();
}
return;
}
} else if (sw == 2) {
u8 addr[6];
#ifdef CONFIG_TWS_BY_CLICK_PAIR_WITHOUT_PAIR
timeout = 500 + (rand32() % 4 + 1) * 500;
tws_api_wait_pair_by_code(bt_get_tws_device_indicate(NULL), bt_get_local_name(), 0);
#else
timeout = 2000 + (rand32() % 4 + 1) * 500;
memcpy(addr, tws_api_get_quick_connect_addr(), 6);
tws_api_set_quick_connect_addr(tws_set_auto_pair_code());
tws_api_create_connection(0);
tws_api_set_quick_connect_addr(addr);
/*tws_api_power_saving_mode_enable();*/
#endif
}
if (++sw > end_sw) {
sw = 0;
}
gtws.pair_timer = sys_timeout_add((void *)sw, connect_and_connectable_switch, timeout);
}
#else
static void connect_and_connectable_switch(void *_sw)
{
int timeout = 0;
int sw = (int)_sw;
gtws.pair_timer = 0;
log_info("switch: %d, state = %x, %d\n", sw, gtws.state,
bt_user_priv_var.auto_connection_counter);
#if CONFIG_TWS_PAIR_MODE == CONFIG_TWS_PAIR_BY_AUTO
if (tws_auto_pair_enable == 1) {
tws_auto_pair_enable = 0;
tws_le_acc_generation_init();
}
#endif
if (tws_remote_state_check()) {
if (sw == 0) {
sw = 1;
} else if (sw == 3) {
sw = 2;
}
puts("tws_exist\n");
}
if (sw == 0) {
__again:
if (bt_user_priv_var.auto_connection_counter > 0) {
timeout = 4000 + (rand32() % 4 + 1) * 500;
bt_user_priv_var.auto_connection_counter -= timeout ;
tws_api_cancle_wait_pair();
tws_api_cancle_create_connection();
user_send_cmd_prepare(USER_CTRL_START_CONNEC_VIA_ADDR, 6,
bt_user_priv_var.auto_connection_addr);
} else {
bt_user_priv_var.auto_connection_counter = 0;
EARPHONE_STATE_CANCEL_PAGE_SCAN();
if (gtws.state & BT_TWS_POWER_ON) {
/*
* 开机回连,获取下一个设备地址
*/
if (get_current_poweron_memory_search_index(NULL)) {
bt_init_ok_search_index();
goto __again;
}
gtws.state &= ~BT_TWS_POWER_ON;
}
if (gtws.state & BT_TWS_SIBLING_CONNECTED) {
tws_api_wait_pair_by_code(bt_get_tws_device_indicate(NULL), bt_get_local_name(), 0);
return;
}
#if CONFIG_TWS_PAIR_MODE == CONFIG_TWS_PAIR_BY_CLICK
if (gtws.state & BT_TWS_UNPAIRED) {
tws_api_wait_pair_by_code(bt_get_tws_device_indicate(NULL), bt_get_local_name(), 0);
return;
}
#endif
sw = 1;
}
}
if (sw == 1) {
if (tws_remote_state_check()) {
timeout = 1000 + (rand32() % 4 + 1) * 500;
} else {
timeout = 2000 + (rand32() % 4 + 1) * 500;
}
tws_api_wait_pair_by_code(bt_get_tws_device_indicate(NULL), bt_get_local_name(), 0);
EARPHONE_STATE_SET_PAGE_SCAN_ENABLE();
} else if (sw == 2) {
if (tws_remote_state_check()) {
timeout = 4000;
} else {
timeout = 1000 + (rand32() % 4 + 1) * 500;
}
tws_remote_state_clear();
tws_api_create_connection(0);
} else if (sw == 3) {
#if CONFIG_TWS_PAIR_MODE == CONFIG_TWS_PAIR_BY_AUTO
timeout = 2000 + (rand32() % 4 + 1) * 500;
tws_auto_pair_enable = 1;
tws_le_acc_generation_init();
tws_api_create_connection(0);
#endif
}
if (gtws.state & BT_TWS_SIBLING_CONNECTED) {
if (++sw > 1) {
sw = 0;
}
} else {
int end_sw = 2;
#ifdef CONFIG_TWS_AUTO_PAIR_WITHOUT_UNPAIR
end_sw = 3;
#elif CONFIG_TWS_PAIR_MODE == CONFIG_TWS_PAIR_BY_AUTO
if (gtws.state & BT_TWS_UNPAIRED) {
end_sw = 3;
}
#endif
if (++sw > end_sw) {
sw = 0;
}
}
gtws.pair_timer = sys_timeout_add((void *)sw, connect_and_connectable_switch, timeout);
}
#endif
static void bt_tws_connect_and_connectable_switch()
{
bt_tws_delete_pair_timer();
#if TCFG_AUDIO_ANC_ENABLE
#if TCFG_ANC_BOX_ENABLE
if (ancbox_get_status()) {
EARPHONE_STATE_SET_PAGE_SCAN_ENABLE();
user_send_cmd_prepare(USER_CTRL_WRITE_SCAN_ENABLE, 0, NULL);
user_send_cmd_prepare(USER_CTRL_WRITE_CONN_ENABLE, 0, NULL);
return;
}
#endif
#endif
if (tws_api_get_role() == TWS_ROLE_MASTER) {
connect_and_connectable_switch(0);
}
}
int bt_tws_start_search_sibling()
{
int state = get_bt_connect_status();
if (gtws.state & BT_TWS_PHONE_CONNECTED) {
return 0;
}
if (gtws.state & BT_TWS_SIBLING_CONNECTED) {
#ifdef CONFIG_TWS_REMOVE_PAIR_ENABLE
puts("===========remove_pairs\n");
if (tws_api_get_role() == TWS_ROLE_MASTER) {
tws_api_remove_pairs();
gtws.state |= BT_TWS_REMOVE_PAIRS;
}
#endif
return 0;
}
if (check_tws_le_aa()) {
return 0;
}
#if CONFIG_TWS_PAIR_MODE == CONFIG_TWS_PAIR_BY_CLICK
log_i("bt_tws_start_search_sibling\n");
gtws.state |= BT_TWS_SEARCH_SIBLING;
#if CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_LEFT_START_PAIR || \
CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_RIGHT_START_PAIR || \
CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_MASTER_AS_LEFT
tws_api_set_local_channel('U');
#endif
bt_tws_search_sibling_and_pair();
return 1;
#endif
return 0;
}
/*
* 自动配对状态定时切换函数
*/
static void __bt_tws_auto_pair_switch(void *priv)
{
u32 timeout;
int sw = (int)priv;
gtws.pair_timer = 0;
printf("bt_tws_auto_pair: %d, %d\n", gtws.auto_pair_timeout, bt_user_priv_var.auto_connection_counter);
if (gtws.auto_pair_timeout < 0 && bt_user_priv_var.auto_connection_counter > 0) {
gtws.auto_pair_timeout = 4000;
timeout = bt_tws_connect_phone();
} else {
timeout = 1000 + ((rand32() % 10) * 200);
gtws.auto_pair_timeout -= timeout;
if (sw == 0) {
tws_api_wait_pair_by_code(bt_get_tws_device_indicate(NULL), bt_get_local_name(), 0);
} else if (sw == 1) {
bt_tws_search_sibling_and_pair();
}
if (++sw > 1) {
sw = 0;
}
}
gtws.pair_timer = sys_timeout_add((void *)sw, __bt_tws_auto_pair_switch, timeout);
}
static void bt_tws_auto_pair_switch(int timeout)
{
bt_tws_delete_pair_timer();
gtws.auto_pair_timeout = timeout;
__bt_tws_auto_pair_switch(NULL);
}
static u8 set_channel_by_code_or_res(void)
{
u8 count = 0;
char channel = 0;
char last_channel = 0;
#if (CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_EXTERN_UP_AS_LEFT)
gpio_set_direction(CONFIG_TWS_CHANNEL_CHECK_IO, 1);
gpio_set_pull_down(CONFIG_TWS_CHANNEL_CHECK_IO, 1);
gpio_set_die(CONFIG_TWS_CHANNEL_CHECK_IO, 1);
for (int i = 0; i < 5; i++) {
os_time_dly(2);
if (gpio_read(CONFIG_TWS_CHANNEL_CHECK_IO)) {
count++;
}
}
gpio_set_direction(CONFIG_TWS_CHANNEL_CHECK_IO, 1);
gpio_set_pull_down(CONFIG_TWS_CHANNEL_CHECK_IO, 0);
gpio_set_die(CONFIG_TWS_CHANNEL_CHECK_IO, 0);
channel = (count >= 3) ? 'L' : 'R';
#elif (CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_EXTERN_DOWN_AS_LEFT)
gpio_set_direction(CONFIG_TWS_CHANNEL_CHECK_IO, 1);
gpio_set_die(CONFIG_TWS_CHANNEL_CHECK_IO, 1);
gpio_set_pull_up(CONFIG_TWS_CHANNEL_CHECK_IO, 1);
for (int i = 0; i < 5; i++) {
os_time_dly(2);
if (gpio_read(CONFIG_TWS_CHANNEL_CHECK_IO)) {
count++;
}
}
gpio_set_direction(CONFIG_TWS_CHANNEL_CHECK_IO, 1);
gpio_set_die(CONFIG_TWS_CHANNEL_CHECK_IO, 0);
gpio_set_pull_up(CONFIG_TWS_CHANNEL_CHECK_IO, 0);
channel = (count >= 3) ? 'R' : 'L';
#elif (CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_AS_LEFT_CHANNEL)
channel = 'L';
#elif (CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_AS_RIGHT_CHANNEL)
channel = 'R';
#elif (CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_SECECT_BY_CHARGESTORE)
syscfg_read(CFG_CHARGESTORE_TWS_CHANNEL, &channel, 1);
#endif
#if CONFIG_TWS_SECECT_CHARGESTORE_PRIO
syscfg_read(CFG_CHARGESTORE_TWS_CHANNEL, &channel, 1);
#endif
if (channel) {
syscfg_read(CFG_TWS_CHANNEL, &last_channel, 1);
if (channel != last_channel) {
syscfg_write(CFG_TWS_CHANNEL, &channel, 1);
}
tws_api_set_local_channel(channel);
return 1;
}
return 0;
}
/*
* 开机tws初始化
*/
__BANK_INIT_ENTRY
int bt_tws_poweron()
{
int err;
u8 addr[6];
char channel;
#if TCFG_TEST_BOX_ENABLE
if (testbox_get_ex_enter_dut_flag()) {
log_info("tws poweron enter dut case\n");
user_send_cmd_prepare(USER_CTRL_WRITE_SCAN_ENABLE, 0, NULL);
user_send_cmd_prepare(USER_CTRL_WRITE_CONN_ENABLE, 0, NULL);
return 0;
}
#endif
#if TCFG_AUDIO_ANC_ENABLE
/*支持ANC训练快速连接，不连接tws*/
#if TCFG_ANC_BOX_ENABLE
if (ancbox_get_status())
#else
if (0)
#endif/*TCFG_ANC_BOX_ENABLE*/
{
EARPHONE_STATE_SET_PAGE_SCAN_ENABLE();
user_send_cmd_prepare(USER_CTRL_WRITE_SCAN_ENABLE, 0, NULL);
user_send_cmd_prepare(USER_CTRL_WRITE_CONN_ENABLE, 0, NULL);
return 0;
} else {
/*tws配对前，先关闭可发现可连接，不影响tws配对状态*/
//user_send_cmd_prepare(USER_CTRL_WRITE_SCAN_DISABLE, 0, NULL);
//user_send_cmd_prepare(USER_CTRL_WRITE_CONN_DISABLE, 0, NULL);
}
#endif/*TCFG_AUDIO_ANC_ENABLE*/
gtws.tws_dly_discon_time = 0;
gtws.state = BT_TWS_POWER_ON;
gtws.connect_time = 0;
lmp_hci_write_page_timeout(12000);
#ifdef CONFIG_A2DP_GAME_MODE_ENABLE
extern void bt_set_low_latency_mode(int enable);
/* tws_api_auto_role_switch_disable(); */
/* bt_set_low_latency_mode(1);//开机默认低延时模式设置 */
#endif
int result = 0;
err = tws_get_sibling_addr(addr, &result);
if (err == 0) {
/*
* 获取到对方地址, 开始连接
*/
printf("\n ---------have tws info----------\n");
gtws.state |= BT_TWS_PAIRED;
EARPHONE_STATE_TWS_INIT(1);
tws_api_set_sibling_addr(addr);
if (set_channel_by_code_or_res() == 0) {
channel = bt_tws_get_local_channel();
tws_api_set_local_channel(channel);
}
#if TCFG_TEST_BOX_ENABLE
if (testbox_get_status()) {
} else
#endif
{
#ifdef CONFIG_NEW_BREDR_ENABLE
/* if (bt_tws_get_local_channel() == 'L') { */
/* syscfg_read(CFG_TWS_LOCAL_ADDR, addr, 6); */
/* } */
u8 local_addr[6];
syscfg_read(CFG_TWS_LOCAL_ADDR, local_addr, 6);
for (int i = 0; i < 6; i++) {
addr[i] += local_addr[i];
}
tws_api_set_quick_connect_addr(addr);
#endif
bt_tws_connect_sibling(CONFIG_TWS_CONNECT_SIBLING_TIMEOUT);
}
} else {
printf("\n ---------no tws info----------\n");
EARPHONE_STATE_TWS_INIT(0);
// no_tws for test
//EARPHONE_STATE_TWS_INIT(1);
//EARPHONE_STATE_SET_PAGE_SCAN_ENABLE();
gtws.state |= BT_TWS_UNPAIRED;
if (set_channel_by_code_or_res() == 0) {
tws_api_set_local_channel('U');
}
#if TCFG_TEST_BOX_ENABLE
if (testbox_get_status()) {
} else
#endif
{
#if CONFIG_TWS_PAIR_MODE == CONFIG_TWS_PAIR_BY_AUTO
/*
* 未配对, 开始自动配对
*/
#ifdef CONFIG_NEW_BREDR_ENABLE
tws_api_set_quick_connect_addr(tws_set_auto_pair_code());
#else
tws_auto_pair_enable = 1;
tws_le_acc_generation_init();
#endif
bt_tws_connect_sibling(6);
#else
#if CONFIG_TWS_PAIR_MODE == CONFIG_TWS_PAIR_BY_CLICK
if (result == VM_INDEX_ERR) {
printf("tws_get_sibling_addr index_err and bt_tws_start_search_sibling =%d\n", result);
bt_tws_start_search_sibling();
} else
#endif
{
/*
* 未配对, 等待发起配对
*/
bt_tws_connect_and_connectable_switch();
/*tws_api_create_connection(0);*/
/*bt_tws_search_sibling_and_pair();*/
}
#endif
}
}
#ifndef CONFIG_NEW_BREDR_ENABLE
tws_remote_state_clear();
#endif
return 0;
}
/*
* 手机开始连接
*/
void bt_tws_hci_event_connect()
{
printf("bt_tws_hci_event_connect: %x\n", gtws.state);
gtws.state &= ~BT_TWS_POWER_ON;
bt_user_priv_var.auto_connection_counter = 0;
bt_tws_delete_pair_timer();
sys_auto_shut_down_disable();
tws_api_power_saving_mode_disable();
tws_sniff_controle_check_disable();
#ifndef CONFIG_NEW_BREDR_ENABLE
tws_remote_state_clear();
#endif
}
int bt_tws_phone_connected()
{
int state;
printf("bt_tws_phone_connected: %x\n", gtws.state);
#if TCFG_TEST_BOX_ENABLE
if (testbox_get_status()) {
return 1;
}
#endif
gtws.state |= BT_TWS_PHONE_CONNECTED;
if (gtws.state & BT_TWS_UNPAIRED) {
return 0;
}
if (!(gtws.state & BT_TWS_SIBLING_CONNECTED)) {
bt_tws_wait_sibling_connect(0);
return 0;
}
if (app_var.phone_dly_discon_time) {
sys_timeout_del(app_var.phone_dly_discon_time);
app_var.phone_dly_discon_time = 0;
return 1;
}
/*
* 获取tws状态，如果正在播歌或打电话则返回1,不播连接成功提示音
*/
if (tws_api_get_role() == TWS_ROLE_MASTER) {
//此时手机已经连接上，同步PHONE_CONN状态
bt_tws_led_state_sync(SYNC_LED_STA_PHONE_CONN, 300);
state = tws_api_get_tws_state();
if (state & (TWS_STA_SBC_OPEN | TWS_STA_ESCO_OPEN) ||
(get_call_status() != BT_CALL_HANGUP)) {
return 1;
}
log_info("[SYNC] TONE SYNC");
bt_tws_play_tone_at_same_time(SYNC_TONE_PHONE_CONNECTED, 1200);
}
return 1;
}
void bt_tws_phone_disconnected()
{
gtws.state &= ~BT_TWS_PHONE_CONNECTED;
printf("bt_tws_phone_disconnected: %x\n", gtws.state);
if (tws_api_get_role() == TWS_ROLE_MASTER) {
tws_api_sync_call_by_uuid('T', SYNC_CMD_SHUT_DOWN_TIME, 400);//同步关机时间
}
bt_user_priv_var.auto_connection_counter = 0;
if (!(gtws.state & BT_TWS_SIBLING_CONNECTED)) {
bt_tws_connect_and_connectable_switch();
}
}
void bt_tws_phone_page_timeout()
{
printf("bt_tws_phone_page_timeout: %x\n", gtws.state);
bt_tws_phone_disconnected();
}
void bt_tws_phone_connect_timeout()
{
log_d("bt_tws_phone_connect_timeout: %x, %d\n", gtws.state, gtws.pair_timer);
gtws.state &= ~BT_TWS_PHONE_CONNECTED;
/*
* 跟手机超时断开,如果对耳未连接则优先连接对耳
*/
if (gtws.state & (BT_TWS_UNPAIRED | BT_TWS_SIBLING_CONNECTED)) {
bt_tws_connect_and_connectable_switch();
} else {
bt_tws_connect_sibling(CONFIG_TWS_CONNECT_SIBLING_TIMEOUT);
}
}
void bt_get_vm_mac_addr(u8 *addr);
void bt_page_scan_for_test(u8 inquiry_en)
{
u8 local_addr[6];
int state = tws_api_get_tws_state();
log_info("\n\n\n\n -------------bt test page scan\n");
bt_tws_delete_pair_timer();
tws_api_cancle_wait_pair();
tws_api_cancle_create_connection();
user_send_cmd_prepare(USER_CTRL_PAGE_CANCEL, 0, NULL);
tws_api_detach(TWS_DETACH_BY_POWEROFF);
user_send_cmd_prepare(USER_CTRL_POWER_OFF, 0, NULL);
if (0 == get_total_connect_dev()) {
log_info("<<<<<no phone connect,instant page_scan,inquiry_scan:%x>>>>>\n", inquiry_en);
bt_get_vm_mac_addr(local_addr);
//log_info("local_adr\n");
//put_buf(local_addr,6);
lmp_hci_write_local_address(local_addr);
if (inquiry_en) {
user_send_cmd_prepare(USER_CTRL_WRITE_SCAN_ENABLE, 0, NULL);
}
user_send_cmd_prepare(USER_CTRL_WRITE_CONN_ENABLE, 0, NULL);
}
gtws.state = 0;
}
int bt_tws_poweroff()
{
log_info("bt_tws_poweroff\n");
bt_tws_delete_pair_timer();
tws_api_cancle_wait_pair();
tws_api_cancle_create_connection();
user_send_cmd_prepare(USER_CTRL_PAGE_CANCEL, 0, NULL);
tws_api_detach(TWS_DETACH_BY_POWEROFF);
tws_profile_exit();
if (tws_api_get_tws_state() & TWS_STA_SIBLING_DISCONNECTED) {
return 1;
}
return 0;
}
void tws_page_scan_deal_by_esco(u8 esco_flag)
{
if (gtws.state & BT_TWS_UNPAIRED) {
return;
}
if (esco_flag) {
bt_tws_delete_pair_timer();
gtws.state &= ~BT_TWS_CONNECT_SIBLING;
tws_api_cancle_create_connection();
tws_api_connect_in_esco();
puts("close scan\n");
}
if (!esco_flag && !(gtws.state & BT_TWS_SIBLING_CONNECTED)) {
puts("open scan22\n");
tws_api_cancle_connect_in_esco();
tws_api_wait_connection(0);
}
}
/*
* 解除配对，清掉对方地址信息和本地声道信息
*/
void bt_tws_remove_pairs()
{
u8 mac_addr[6];
char channel = 'U';
char tws_channel = 0;
gtws.state &= ~BT_TWS_REMOVE_PAIRS;
memset(mac_addr, 0xFF, 6);
syscfg_write(CFG_TWS_COMMON_ADDR, mac_addr, 6);
syscfg_write(CFG_TWS_REMOTE_ADDR, mac_addr, 6);
syscfg_read(CFG_BT_MAC_ADDR, mac_addr, 6);
lmp_hci_write_local_address(mac_addr);
#if (CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_LEFT_START_PAIR) ||\
(CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_RIGHT_START_PAIR) ||\
(CONFIG_TWS_CHANNEL_SELECT == CONFIG_TWS_MASTER_AS_LEFT)
#if CONFIG_TWS_SECECT_CHARGESTORE_PRIO
syscfg_read(CFG_CHARGESTORE_TWS_CHANNEL, &tws_channel, 1);
#endif
if ((tws_channel != 'L') && (tws_channel != 'R')) {
syscfg_write(CFG_TWS_CHANNEL, &channel, 1);
tws_api_set_local_channel(channel);
}
#endif
tws_api_clear_connect_aa();
bt_tws_wait_pair_and_phone_connect();
}
#if TCFG_ADSP_UART_ENABLE
extern void adsp_deal_sibling_uart_command(u8 type, u8 cmd);
void tws_sync_uart_command(u8 type, u8 cmd)
{
struct tws_sync_info_t sync_adsp_uart_command;
sync_adsp_uart_command.type = TWS_SYNC_ADSP_UART_CMD;
sync_adsp_uart_command.u.adsp_cmd[0] = type;
sync_adsp_uart_command.u.adsp_cmd[1] = cmd;
tws_api_send_data_to_sibling((u8 *)&sync_adsp_uart_command, sizeof(sync_adsp_uart_command));
}
#endif
extern void set_tws_sibling_bat_level(u16 level);
#define TWS_FUNC_ID_VOL_SYNC TWS_FUNC_ID('V', 'O', 'L', 'S')
static void bt_tws_vol_sync(void *_data, u16 len, bool rx)
{
if (rx) {
u8 *data = (u8 *)_data;
app_audio_set_volume(APP_AUDIO_STATE_MUSIC, data[0], 1);
app_audio_set_volume(APP_AUDIO_STATE_CALL, data[1], 1);
r_printf("vol_sync: %d, %d\n", data[0], data[1]);
}
}
REGISTER_TWS_FUNC_STUB(app_vol_sync_stub) = {
.func_id = TWS_FUNC_ID_VOL_SYNC,
.func = bt_tws_vol_sync,
};
void bt_tws_sync_volume()
{
u8 data[2];
data[0] = app_audio_get_volume(APP_AUDIO_STATE_MUSIC);
data[1] = app_audio_get_volume(APP_AUDIO_STATE_CALL);
tws_api_send_data_to_slave(data, 2, TWS_FUNC_ID_VOL_SYNC);
}
#if TCFG_AUDIO_ANC_ENABLE
#define TWS_FUNC_ID_ANC_SYNC TWS_FUNC_ID('A', 'N', 'C', 'S')
static void bt_tws_anc_sync(void *_data, u16 len, bool rx)
{
if (rx) {
u8 *data = (u8 *)_data;
//r_printf("[slave]anc_sync: %d, %d\n", data[0], data[1]);
#if TCFG_AUDIO_ANC_ACOUSTIC_DETECTOR_EN
/*先关闭adt，同步adt状态，然后同步anc，在anc里面做判断开adt*/
audio_anc_icsd_adt_state_sync(data);
#else
anc_mode_sync(data);
#endif /*TCFG_AUDIO_ANC_ACOUSTIC_DETECTOR_EN*/
}
}
REGISTER_TWS_FUNC_STUB(app_anc_sync_stub) = {
.func_id = TWS_FUNC_ID_ANC_SYNC,
.func = bt_tws_anc_sync,
};
void bt_tws_sync_anc(void)
{
u8 data[5];
#if TCFG_AUDIO_ANC_ACOUSTIC_DETECTOR_EN
/*处理tws配对前一瞬间，在anc off开adt的情况*/
data[0] = anc_new_target_mode_get();
#else
data[0] = anc_mode_get();
#endif /*TCFG_AUDIO_ANC_ACOUSTIC_DETECTOR_EN*/
#if ANC_EAR_ADAPTIVE_EN
data[1] = anc_ear_adaptive_seq_get();
#endif/*ANC_EAR_ADAPTIVE_EN*/
#if ANC_MULT_ORDER_ENABLE
data[2] = audio_anc_mult_scene_get();
#endif/*ANC_MULT_ORDER_ENABLE*/
#if TCFG_AUDIO_ANC_ACOUSTIC_DETECTOR_EN
data[3] = get_icsd_adt_mode();
data[4] = get_speak_to_chat_state();
printf("%s:%d, %x, %d", __func__, __LINE__, data[3], data[4]);
#endif /*TCFG_AUDIO_ANC_ACOUSTIC_DETECTOR_EN*/
//r_printf("[master]anc_sync: %d, %d\n", data[0], data[1]);
tws_api_send_data_to_slave(data, 5, TWS_FUNC_ID_ANC_SYNC);
}
#if (defined ANC_ADAPTIVE_EN) && ANC_ADAPTIVE_EN
#define TWS_FUNC_ID_ANC_ADAP_SYNC TWS_FUNC_ID('A', 'N', 'C', 'A')
static void bt_tws_anc_adap_sync(int dat, int err)
{
/* printf("%s,%d, lvl 0X%x\n", __func__, __LINE__, dat); */
audio_anc_adap_sync((dat >> 8), (dat & 0XFF), err);
}
TWS_SYNC_CALL_REGISTER(tws_anc_adaptive_sync) = {
.uuid = TWS_FUNC_ID_ANC_ADAP_SYNC,
.task_name = "anc",
.func = bt_tws_anc_adap_sync,
};
void bt_tws_anc_adap_sync_send(int ref_lvl, int err_lvl, int msec)
{
tws_api_sync_call_by_uuid(TWS_FUNC_ID_ANC_ADAP_SYNC, ((ref_lvl << 8) | err_lvl), msec);
}
#define TWS_FUNC_ID_ANC_ADAP_COMPARE_SYNC TWS_FUNC_ID('A', 'N', 'C', 'B')
static void bt_tws_anc_adap_compare(void *_data, u16 len, bool rx)
{
if (rx) {
u8 *data = (u8 *)_data;
/* r_printf("tws_anc_adap_compare: %d, %d\n", data[0], data[1]); */
audio_anc_adap_lvl_compare(data[0], data[1]);
}
}
REGISTER_TWS_FUNC_STUB(tws_anc_adap_compare) = {
.func_id = TWS_FUNC_ID_ANC_ADAP_COMPARE_SYNC,
.func = bt_tws_anc_adap_compare,
};
int bt_tws_anc_adap_compare_send(int ref_lvl, int err_lvl)
{
u8 data[2];
int ret = -EINVAL;
data[0] = ref_lvl;
data[1] = err_lvl;
/* r_printf("tws_anc_adap_sync: %d, %d\n", data[0], data[1]); */
local_irq_disable();
ret = tws_api_send_data_to_sibling(data, 2, TWS_FUNC_ID_ANC_ADAP_COMPARE_SYNC);
local_irq_enable();
return ret;
}
#endif/*(defined ANC_ADAPTIVE_EN) && ANC_ADAPTIVE_EN*/
#endif/*TCFG_AUDIO_ANC_ENABLE*/
#if TCFG_AUDIO_HEARING_AID_ENABLE
extern u8 get_hearing_aid_state(void);
extern void hearing_aid_state_sync(u8 state);
#define TWS_FUNC_ID_HEARING_AID_SYNC TWS_FUNC_ID('D', 'H', 'A', 'S')
static void bt_tws_hearing_aid_sync(int dat, int err)
{
hearing_aid_state_sync(dat);
}
TWS_SYNC_CALL_REGISTER(tws_hearing_aid_sync) = {
.uuid = TWS_FUNC_ID_HEARING_AID_SYNC,
.task_name = "app_core",
.func = bt_tws_hearing_aid_sync,
};
void bt_tws_hearing_aid_sync_send(void)
{
int state = get_hearing_aid_state();
int msec = 400;
if (state) {
tws_api_sync_call_by_uuid(TWS_FUNC_ID_HEARING_AID_SYNC, state, msec);
}
}
#endif /*TCFG_AUDIO_HEARING_AID_ENABLE*/
#if TCFG_AUDIO_SPATIAL_EFFECT_ENABLE
#define TWS_FUNC_ID_SPATIAL_EFFECT_STATE_SYNC TWS_FUNC_ID('A', 'S', 'E', 'S')
extern void a2dp_spatial_audio_setup(u8 en, u8 head_track);
extern u8 get_spatial_audio_enable();
extern u8 get_a2dp_spatial_audio_head_tracked(void);
static void bt_tws_spatial_effect_state_sync(void *_data, u16 len, bool rx)
{
if (rx) {
u8 *data = (u8 *)_data;
//r_printf("[slave]anc_sync: %d, %d\n", data[0], data[1]);
a2dp_spatial_audio_setup(data[0], data[1]);
}
}
REGISTER_TWS_FUNC_STUB(app_spatial_effect_state_sync_stub) = {
.func_id = TWS_FUNC_ID_SPATIAL_EFFECT_STATE_SYNC,
.func = bt_tws_spatial_effect_state_sync,
};
void bt_tws_sync_spatial_effect_state(void)
{
u8 data[2];
data[0] = get_spatial_audio_enable();
data[1] = get_a2dp_spatial_audio_head_tracked();;
//r_printf("[master]anc_sync: %d, %d\n", data[0], data[1]);
tws_api_send_data_to_slave(data, 2, TWS_FUNC_ID_SPATIAL_EFFECT_STATE_SYNC);
}
#endif /*TCFG_AUDIO_SPATIAL_EFFECT_ENABLE*/
void tws_conn_auto_test(void *p)
{
cpu_reset();
}
/*
* tws事件状态处理函数
*/
int bt_tws_connction_status_event_handler(struct bt_event *evt)
{
u8 addr[4][6];
int state;
int pair_suss = 0;
int role = evt->args[0];
int phone_link_connection = evt->args[1];
int reason = evt->args[2];
u16 random_num = 0;
char channel = 0;
u8 mac_addr[6];
int work_state = 0;
STATUS *p_tone = get_tone_config();
STATUS *p_led = get_led_config();
log_info("tws-user: role= %d, phone_link_connection %d, reason=%d,event= %d\n",
role, phone_link_connection, reason, evt->event);
switch (evt->event) {
case TWS_EVENT_CONNECTED:
log_info("tws_event_pair_suss: %x\n", gtws.state);
syscfg_read(CFG_TWS_REMOTE_ADDR, addr[0], 6);
syscfg_read(CFG_TWS_COMMON_ADDR, addr[1], 6);
tws_api_get_sibling_addr(addr[2]);
tws_api_get_local_addr(addr[3]);
/*
* 记录对方地址
*/
if (memcmp(addr[0], addr[2], 6)) {
syscfg_write(CFG_TWS_REMOTE_ADDR, addr[2], 6);
pair_suss = 1;
log_info("rec tws addr\n");
}
if (memcmp(addr[1], addr[3], 6)) {
syscfg_write(CFG_TWS_COMMON_ADDR, addr[3], 6);
pair_suss = 1;
log_info("rec comm addr\n");
}
if (pair_suss) {
gtws.state = BT_TWS_PAIRED;
extern void bt_update_mac_addr(u8 * addr);
bt_update_mac_addr((void *)addr[3]);
}
/*
* 记录左右声道
*/
channel = tws_api_get_local_channel();
if (channel != bt_tws_get_local_channel()) {
syscfg_write(CFG_TWS_CHANNEL, &channel, 1);
}
r_printf("tws_local_channel: %c\n", channel);
EARPHONE_STATE_TWS_CONNECTED(pair_suss, addr[3]);
#if CONFIG_TWS_PAIR_MODE == CONFIG_TWS_PAIR_BY_AUTO
if (tws_auto_pair_enable) {
tws_auto_pair_enable = 0;
tws_le_acc_generation_init();
}
#endif
#ifdef CONFIG_NEW_BREDR_ENABLE
/* if (channel == 'L') { */
/* syscfg_read(CFG_TWS_LOCAL_ADDR, addr[2], 6); */
/* } */
u8 local_addr[6];
syscfg_read(CFG_TWS_LOCAL_ADDR, local_addr, 6);
for (int i = 0; i < 6; i++) {
addr[2][i] += local_addr[i];
}
tws_api_set_quick_connect_addr(addr[2]);
#else
tws_api_set_connect_aa(channel);
tws_remote_state_clear();
#endif
if (reason & (TWS_STA_ESCO_OPEN | TWS_STA_SBC_OPEN)) {
if (role == TWS_ROLE_SLAVE) {
gtws.state |= BT_TWS_AUDIO_PLAYING;
}
}
if (!phone_link_connection ||
(reason & (TWS_STA_ESCO_OPEN | TWS_STA_SBC_OPEN))) {
pwm_led_clk_set(PWM_LED_CLK_BTOSC_24M);
}
/*
* TWS连接成功, 主机尝试回连手机
*/
if (gtws.connect_time) {
if (role == TWS_ROLE_MASTER) {
bt_user_priv_var.auto_connection_counter = gtws.connect_time;
}
gtws.connect_time = 0;
}
gtws.state &= ~BT_TWS_TIMEOUT;
gtws.state |= BT_TWS_SIBLING_CONNECTED;
state = evt->args[2];
if (role == TWS_ROLE_MASTER) {
if (!phone_link_connection) {
//还没连上手机
log_info("[SYNC] LED SYNC");
bt_tws_led_state_sync(SYNC_LED_STA_TWS_CONN, 400);
} else {
bt_tws_led_state_sync(SYNC_LED_STA_PHONE_CONN, 400);
}
if (!get_bt_tws_discon_dly_state() && (get_call_status() == BT_CALL_HANGUP) && !(state & TWS_STA_SBC_OPEN)) {
//通话状态不播提示音
log_info("[SYNC] TONE SYNC");
bt_tws_play_tone_at_same_time(SYNC_TONE_TWS_CONNECTED, 400);
}
if (get_call_status() == BT_CALL_INCOMING) {
if (bt_user_priv_var.phone_ring_flag && !bt_user_priv_var.inband_ringtone) {
printf("<<<<<<<<<phone_con_sync_num_ring \n");
bt_user_priv_var.phone_con_sync_ring = 1;//主机来电过程，从机连接加入
#if BT_PHONE_NUMBER
bt_user_priv_var.phone_con_sync_num_ring = 1;//主机来电过程，从机连接加入
bt_tws_sync_phone_num(NULL);
#endif
}
}
}
#if TCFG_CHARGESTORE_ENABLE
chargestore_sync_chg_level();//同步充电舱电量
#endif
#if TCFG_AUDIO_ANC_ENABLE
bt_tws_sync_anc();
#endif/*TCFG_AUDIO_ANC_ENABLE*/
#if TCFG_AUDIO_HEARING_AID_ENABLE
bt_tws_hearing_aid_sync_send();
#endif /*TCFG_AUDIO_HEARING_AID_ENABLE*/
#if TCFG_AUDIO_SPATIAL_EFFECT_ENABLE
extern void bt_tws_sync_spatial_effect_state(void);
bt_tws_sync_spatial_effect_state();
#endif /*TCFG_AUDIO_SPATIAL_EFFECT_ENABLE*/
tws_sync_bat_level(); //同步电量到对耳
bt_tws_sync_volume();
bt_tws_delete_pair_timer();
#if TCFG_EAR_DETECT_ENABLE
extern void tws_sync_ear_detect_state(u8 need_do);
tws_sync_ear_detect_state(0);
#endif
if (phone_link_connection == 0) {
if (role == TWS_ROLE_MASTER) {
bt_tws_connect_and_connectable_switch();
} else {
tws_api_cancle_wait_pair();
}
sys_auto_shut_down_disable();
sys_auto_shut_down_enable();
/* tws_sniff_controle_check_enable(); */
}
//ui_update_status(STATUS_BT_TWS_CONN);
pbg_user_set_tws_state(1);
/*if (tws_api_get_role() == TWS_ROLE_SLAVE) {
void sys_enter_soft_poweroff(void *priv);
sys_timeout_add((void *)1, sys_enter_soft_poweroff, 5000);
}*/
gtws.state &= ~BT_TWS_DISCON_DLY_TIMEOUT;
gtws.state &= ~BT_TWS_DISCON_DLY_TIMEOUT_NO_CONN;
if (gtws.tws_dly_discon_time) {
r_printf("gtws.tws_dly_discon_time_del=0x%x\n", gtws.tws_dly_discon_time);
sys_timeout_del(gtws.tws_dly_discon_time);
gtws.tws_dly_discon_time = 0;
}
break;
case TWS_EVENT_SEARCH_TIMEOUT:
/*
* 发起配对超时, 等待手机连接
*/
gtws.state &= ~BT_TWS_SEARCH_SIBLING;
#if CONFIG_TWS_PAIR_MODE == CONFIG_TWS_PAIR_BY_CLICK
tws_api_set_local_channel(bt_tws_get_local_channel());
lmp_hci_write_local_address(gtws.addr);
#endif
bt_tws_connect_and_connectable_switch();
pbg_user_set_tws_state(0);
break;
case TWS_EVENT_CONNECTION_TIMEOUT:
/*
* TWS连接超时
*/
log_info("tws_event_pair_timeout: %x\n", gtws.state);
pbg_user_set_tws_state(0);
#if TCFG_TEST_BOX_ENABLE
if (testbox_get_status()) {
break;
}
#endif
if (gtws.state & BT_TWS_UNPAIRED) {
/*
* 配对超时
*/
gtws.state &= ~BT_TWS_SEARCH_SIBLING;
#if CONFIG_TWS_PAIR_MODE == CONFIG_TWS_PAIR_BY_CLICK
tws_api_set_local_channel(bt_tws_get_local_channel());
lmp_hci_write_local_address(gtws.addr);
#endif
bt_tws_connect_and_connectable_switch();
} else {
if (phone_link_connection) {
bt_tws_wait_sibling_connect(0);
} else {
if (gtws.state & BT_TWS_TIMEOUT) {
gtws.state &= ~BT_TWS_TIMEOUT;
gtws.connect_time = bt_user_priv_var.auto_connection_counter;
bt_user_priv_var.auto_connection_counter = 0;
}
bt_tws_connect_and_connectable_switch();
}
}
break;
case TWS_EVENT_CONNECTION_DETACH:
/*
* TWS连接断开
*/
if (app_var.goto_poweroff_flag) {
break;
}
work_state = evt->args[3];
log_info("tws_event_connection_detach: state: %x,%x\n", gtws.state, work_state);
pbg_user_set_tws_state(0);
app_power_set_tws_sibling_bat_level(0xff, 0xff);
#if TCFG_CHARGESTORE_ENABLE
chargestore_set_sibling_chg_lev(0xff);
#endif
if ((!a2dp_get_status()) && (get_call_status() == BT_CALL_HANGUP)) { //如果当前正在播歌，切回RC会导致下次从机开机回连后灯状态不同步
pwm_led_clk_set((!TCFG_LOWPOWER_BTOSC_DISABLE) ? PWM_LED_CLK_RC32K : PWM_LED_CLK_BTOSC_24M);
//pwm_led_clk_set(PWM_LED_CLK_RC32K);
}
#if TCFG_TEST_BOX_ENABLE
if (testbox_get_status()) {
break;
}
#endif
#if TWS_DLY_DISCONN_TIME
if (work_state && reason == TWS_DETACH_BY_SUPER_TIMEOUT) {
gtws.tws_dly_discon_time = sys_timeout_add((void *)role, tws_disconn_dly_deal, TWS_DLY_DISCONN_TIME);
r_printf("gtws.tws_dly_discon_time=%d", gtws.tws_dly_discon_time);
}
#endif
if (phone_link_connection) {
ui_update_status(STATUS_BT_CONN);
extern void power_event_to_user(u8 event);
power_event_to_user(POWER_EVENT_POWER_CHANGE);
user_send_cmd_prepare(USER_CTRL_HFP_CMD_UPDATE_BATTARY, 0, NULL); //对耳断开后如果手机还连着，主动推一次电量给手机
} else {
ui_update_status(STATUS_BT_TWS_DISCONN);
}
if ((gtws.state & BT_TWS_SIBLING_CONNECTED) && (!app_var.goto_poweroff_flag)) {
#if CONFIG_TWS_POWEROFF_SAME_TIME
extern u8 poweroff_sametime_flag;
if (!app_var.goto_poweroff_flag && !poweroff_sametime_flag && !phone_link_connection && (reason != TWS_DETACH_BY_REMOVE_PAIRS)) { /*关机不播断开提示音*/
if (gtws.tws_dly_discon_time) {
gtws.state |= BT_TWS_DISCON_DLY_TIMEOUT;
if (work_state & TWS_STA_PHONE_CONNECTED) {
gtws.state |= BT_TWS_DISCON_DLY_TIMEOUT_NO_CONN;
}
} else {
tone_play_index(p_tone->tws_disconnect, 1);
}
}
#else
if (!app_var.goto_poweroff_flag && !phone_link_connection && (reason != TWS_DETACH_BY_REMOVE_PAIRS)) {
if (gtws.tws_dly_discon_time) {
gtws.state |= BT_TWS_DISCON_DLY_TIMEOUT;
} else {
tone_play_index(p_tone->tws_disconnect, 1);
}
}
#endif
gtws.state &= ~BT_TWS_SIBLING_CONNECTED;
}
#if (TCFG_AUDIO_HEARING_AID_ENABLE && TCFG_AUDIO_DHA_FITTING_ENABLE)
/*辅听验配下，对耳断开连接时，主动告诉app当前连接左右耳机辅听状态*/
extern u8 get_rcsp_connect_status(void);
extern int get_hearing_aid_state_cmd_info(u8 * data);
extern u32 hearing_aid_rcsp_notify(u8 * data, u16 data_len);
extern void audio_dha_fitting_sync_close(void);
if (get_rcsp_connect_status()) {
/*主动推送辅听状态信息*/
u8 tmp[4];
get_hearing_aid_state_cmd_info(tmp);
/*TWS掉线，关闭验配*/
tmp[3] = 0;
hearing_aid_rcsp_notify(tmp, 4);
}
audio_dha_fitting_sync_close();
#endif /*TCFG_AUDIO_HEARING_AID_ENABLE && TCFG_AUDIO_DHA_FITTING_ENABLE*/
if (reason == TWS_DETACH_BY_REMOVE_PAIRS) {
gtws.state = BT_TWS_UNPAIRED;
printf("<<<<<<<<<<<<<<<<<<<<<<tws detach by remove pairs>>>>>>>>>>>>>>>>>>>\n");
break;
}
if (get_esco_coder_busy_flag()) {
tws_api_connect_in_esco();
break;
}
//非测试盒在仓测试，直连蓝牙
if (reason == TWS_DETACH_BY_TESTBOX_CON) {
puts(">>>>>>>>>>>>>>>>TWS_DETACH_BY_TESTBOX_CON<<<<<<<<<<<<<<<<<<<\n");
gtws.state &= ~BT_TWS_PAIRED;
gtws.state |= BT_TWS_UNPAIRED;
//syscfg_read(CFG_BT_MAC_ADDR, mac_addr, 6);
if (!phone_link_connection) {
get_random_number(mac_addr, 6);
lmp_hci_write_local_address(mac_addr);
bt_tws_wait_pair_and_phone_connect();
}
break;
}
if (phone_link_connection) {
bt_tws_wait_sibling_connect(0);
} else {
if (reason == TWS_DETACH_BY_SUPER_TIMEOUT) {
if (gtws.state & BT_TWS_REMOVE_PAIRS) {
bt_tws_remove_pairs();
break;
}
if (role == TWS_ROLE_SLAVE) {
gtws.state |= BT_TWS_TIMEOUT;
gtws.connect_time = bt_user_priv_var.auto_connection_counter;
bt_user_priv_var.auto_connection_counter = 0;
}
bt_tws_connect_sibling(6);
} else {
bt_tws_connect_and_connectable_switch();
}
}
break;
case TWS_EVENT_PHONE_LINK_DETACH:
/*
* 跟手机的链路LMP层已完全断开, 只有tws在连接状态才会收到此事件
*/
printf("tws_event_phone_link_detach: %x\n", gtws.state);
if (app_var.goto_poweroff_flag) {
break;
}
#if TCFG_TEST_BOX_ENABLE
if (testbox_get_status()) {
break;
}
#endif
sys_auto_shut_down_enable();
if ((reason != 0x08) && (reason != 0x0b)) {
bt_user_priv_var.auto_connection_counter = 0;
} else {
if (reason == 0x0b) {
bt_user_priv_var.auto_connection_counter = (8 * 1000);
}
}
bt_tws_connect_and_connectable_switch();
tws_sniff_controle_check_enable();
break;
case TWS_EVENT_REMOVE_PAIRS:
log_info("tws_event_remove_pairs\n");
tone_play_index(p_tone->tws_disconnect, 1);
bt_tws_remove_pairs();
app_power_set_tws_sibling_bat_level(0xff, 0xff);
#if TCFG_CHARGESTORE_ENABLE
chargestore_set_sibling_chg_lev(0xff);
#endif
pwm_led_clk_set((!TCFG_LOWPOWER_BTOSC_DISABLE) ? PWM_LED_CLK_RC32K : PWM_LED_CLK_BTOSC_24M);
//pwm_led_clk_set(PWM_LED_CLK_RC32K);
//tone_play(TONE_TWS_DISCONN);
pbg_user_set_tws_state(0);
break;
case TWS_EVENT_SYNC_FUN_CMD:
log_d("TWS_EVENT_SYNC_FUN_CMD: %x\n", reason);
/*
* 主从同步调用函数处理
*/
if (reason == SYNC_CMD_POWER_OFF_TOGETHER) {
extern void sys_enter_soft_poweroff(void *priv);
sys_enter_soft_poweroff((void *)3);
} else if (reason == SYNC_CMD_SHUT_DOWN_TIME) {
r_printf(" SYNC_CMD_SHUT_DOWN_TIME");
sys_auto_shut_down_disable();
sys_auto_shut_down_enable();
} else if (reason == SYNC_CMD_LOW_LATENCY_ENABLE) {
if (earphone_a2dp_codec_set_low_latency_mode(1, 600) == 0) {
tone_play(TONE_LOW_LATENCY_IN, 1);
}
} else if (reason == SYNC_CMD_LOW_LATENCY_DISABLE) {
if (earphone_a2dp_codec_set_low_latency_mode(0, 600) == 0) {
tone_play(TONE_LOW_LATENCY_OUT, 1);
}
} else if (reason == SYNC_CMD_EARPHONE_CHAREG_START) {
if (a2dp_get_status() != BT_MUSIC_STATUS_STARTING) {
g_printf("TWS MUSIC PLAY");
user_send_cmd_prepare(USER_CTRL_AVCTP_OPID_PLAY, 0, NULL);
}
} else if (reason == SYNC_CMD_IRSENSOR_EVENT_NEAR) {
g_printf("TWS NEAR START MUSIC PLAY");
g_printf("a2dp_get_status = %d", a2dp_get_status());
if (a2dp_get_status() != BT_MUSIC_STATUS_STARTING) {
r_printf("START...\n");
user_send_cmd_prepare(USER_CTRL_AVCTP_OPID_PLAY, 0, NULL);
}
} else if (reason == SYNC_CMD_IRSENSOR_EVENT_FAR) {
g_printf("TWS FAR STOP MUSIC PLAY");
g_printf("a2dp_get_status = %d", a2dp_get_status());
if (a2dp_get_status() == BT_MUSIC_STATUS_STARTING) {
r_printf("STOP...\n");
user_send_cmd_prepare(USER_CTRL_AVCTP_OPID_PAUSE, 0, NULL);
}
}
break;
case TWS_EVENT_ROLE_SWITCH:
if (!(tws_api_get_tws_state() & TWS_STA_PHONE_CONNECTED)) {
bt_tws_connect_and_connectable_switch();
tws_sniff_controle_check_enable();
}
if (role == TWS_ROLE_MASTER) {
} else {
}
EARPHONE_STATE_ROLE_SWITCH(role);
break;
case TWS_EVENT_ESCO_ADD_CONNECT:
bt_tws_sync_volume();
break;
case TWS_EVENT_MODE_CHANGE:
log_info("TWS_EVENT_MODE_CHANGE : %d", evt->args[0]);
if (evt->args[0] == 0) {
if (0 == (tws_api_get_tws_state() & TWS_STA_PHONE_CONNECTED)) {
tws_sniff_controle_check_enable();
}
}
break;
case TWS_EVENT_TONE_TEST:
log_info("TWS_EVENT_TEST : %d", evt->args[0]);
int tone_play_index(u8 index, u8 preemption);
tone_play_index(evt->args[0], 1);
break;
}
return 0;
}
/*
* 提示音同步播放
*/
static void play_tone_at_same_time(int tone_name, int err)
{
STATUS *p_tone = get_tone_config();
int state;
switch (tone_name) {
#if TCFG_EAR_DETECT_ENABLE
case SYNC_TONE_EARDET_IN:
tone_play(TONE_EAR_CHECK, 1);
break;
#endif
case SYNC_TONE_TWS_CONNECTED:
#if TCFG_DEC2TWS_ENABLE
break;
#endif
tone_play_index(p_tone->tws_connect_ok, 1);
break;
case SYNC_TONE_PHONE_CONNECTED:
if (err != -TWS_SYNC_CALL_RX) {
state = tws_api_get_tws_state();
if (state & (TWS_STA_SBC_OPEN | TWS_STA_ESCO_OPEN) ||
(get_call_status() != BT_CALL_HANGUP)) {
break;
}
tone_play_index(p_tone->bt_connect_ok, 1);
}
break;
case SYNC_TONE_PHONE_DISCONNECTED:
/* 关机不播断开提示音 */
if (!app_var.goto_poweroff_flag) {
tone_play_index(p_tone->bt_disconnect, 1);
}
ui_update_status(STATUS_BT_TWS_CONN);
break;
case SYNC_TONE_MAX_VOL:
#if TCFG_MAX_VOL_PROMPT
if (p_tone->max_vol != IDEX_TONE_NONE) {
tone_play_index(p_tone->max_vol, 0);
} else {
/* tone_sin_play(150, 1); */
}
#endif
break;
case SYNC_TONE_POWER_OFF:
y_printf("SYNC_TONE_POWER_OFF\n");
if (app_var.goto_poweroff_flag == 1) {
app_var.goto_poweroff_flag = 2;
tone_play_index(p_tone->power_off, 0);
}
bt_tws_poweroff();
break;
case SYNC_TONE_PHONE_NUM:
if (bt_user_priv_var.phone_con_sync_num_ring) {
break;
}
if (tws_api_get_role() == TWS_ROLE_SLAVE) {
if (bt_user_priv_var.phone_timer_id) {
sys_timeout_del(bt_user_priv_var.phone_timer_id);
bt_user_priv_var.phone_timer_id = 0;
}
}
if (bt_user_priv_var.phone_ring_flag) {
phone_num_play_timer(NULL);
}
break;
case SYNC_TONE_PHONE_RING:
if (bt_user_priv_var.phone_ring_flag) {
if (bt_user_priv_var.phone_con_sync_ring) {
if (phone_ring_play_start()) {
bt_user_priv_var.phone_con_sync_ring = 0;
if (tws_api_get_role() == TWS_ROLE_MASTER) {
//播完一声来电铃声之后,关闭aec、msbc_dec之后再次同步播来电铃声
}
}
} else {
phone_ring_play_start();
}
}
break;
case SYNC_TONE_PHONE_NUM_RING:
if (bt_user_priv_var.phone_ring_flag) {
if (phone_ring_play_start()) {
if (tws_api_get_role() == TWS_ROLE_MASTER) {
//播完一声来电铃声之后,关闭aec、msbc_dec之后再次同步播来电铃声
bt_user_priv_var.phone_con_sync_ring = 0;
}
bt_user_priv_var.phone_con_sync_num_ring = 1;
}
}
break;
#if TCFG_AUDIO_ANC_ENABLE
case SYNC_TONE_ANC_ON:
case SYNC_TONE_ANC_OFF:
case SYNC_TONE_ANC_TRANS:
anc_tone_sync_play(tone_name);
break;
#endif
#if TCFG_AUDIO_HEARING_AID_ENABLE
case SYNC_TONE_HEARING_AID_OPEN:
extern int audio_hearing_aid_open(void);
audio_hearing_aid_open();
break;
#endif /*TCFG_AUDIO_HEARING_AID_ENABLE*/
#if TCFG_AUDIO_HEARING_AID_ENABLE
case SYNC_TONE_DHA_FITTING_CLOSE:
extern int hearing_aid_fitting_start(u8 en);
extern u8 set_hearing_aid_fitting_state(u8 state);
hearing_aid_fitting_start(0);
set_hearing_aid_fitting_state(0);
break;
#endif /*TCFG_AUDIO_HEARING_AID_ENABLE*/
}
}
TWS_SYNC_CALL_REGISTER(tws_tone_play) = {
.uuid = 0x123A9E50,
.task_name = "app_core",
.func = play_tone_at_same_time,
};
void bt_tws_play_tone_at_same_time(int tone_name, int msec)
{
tws_api_sync_call_by_uuid(0x123A9E50, tone_name, msec);
}
/*
* LED状态同步
*/
static void led_state_sync_handler(int state, int err)
{
switch (state) {
case SYNC_LED_STA_TWS_CONN:
pwm_led_mode_set(PWM_LED_ALL_OFF);
ui_update_status(STATUS_BT_TWS_CONN);
break;
case SYNC_LED_STA_PHONE_CONN:
if (err != -TWS_SYNC_CALL_RX) {
pwm_led_mode_set(PWM_LED_ALL_OFF);
ui_update_status(STATUS_BT_CONN);
}
break;
}
}
TWS_SYNC_CALL_REGISTER(tws_led_sync) = {
.uuid = 0x2A1E3095,
.task_name = "app_core",
.func = led_state_sync_handler,
};
void bt_tws_led_state_sync(int led_state, int msec)
{
tws_api_sync_call_by_uuid(0x2A1E3095, led_state, msec);
}
void tws_cancle_all_noconn()
{
bt_tws_delete_pair_timer();
tws_api_cancle_wait_pair();
tws_api_cancle_create_connection();
user_send_cmd_prepare(USER_CTRL_PAGE_CANCEL, 0, NULL);
}
bool get_tws_sibling_connect_state(void)
{
if (gtws.state & BT_TWS_SIBLING_CONNECTED) {
return TRUE;
}
return FALSE;
}
bool get_tws_phone_connect_state(void)
{
if (gtws.state & BT_TWS_PHONE_CONNECTED) {
return TRUE;
}
return FALSE;
}
#define TWS_SNIFF_CNT_TIME 5000 //ms
static void bt_tws_enter_sniff(void *parm)
{
gtws.sniff_timer = 0;
extern void tws_tx_sniff_req(void);
tws_tx_sniff_req();
}
void tws_sniff_controle_check_reset(void)
{
if (gtws.sniff_timer) {
sys_timer_modify(gtws.sniff_timer, TWS_SNIFF_CNT_TIME);
}
}
void tws_sniff_controle_check_enable(void)
{
#if (CONFIG_BT_TWS_SNIFF == 0)
return;
#endif
if (update_check_sniff_en() == 0) {
return;
}
if (gtws.sniff_timer == 0) {
gtws.sniff_timer = sys_timeout_add(NULL, bt_tws_enter_sniff, TWS_SNIFF_CNT_TIME);
}
}
void tws_sniff_controle_check_disable(void)
{
#if (CONFIG_BT_TWS_SNIFF == 0)
return;
#endif
if (gtws.sniff_timer) {
sys_timeout_del(gtws.sniff_timer);
gtws.sniff_timer = 0;
}
}
extern int tws_in_sniff_state();
extern void tws_link_check_for_ble_link_switch(void);
static u16 ble_try_switch_timer;
void tws_phone_ble_link_try_switch(void)
{
//等待退出tws sniff
if (!tws_in_sniff_state()) {
//开始启动ble controller检查,满足切换条件进行链路切换;
tws_link_check_for_ble_link_switch();
sys_timeout_del(ble_try_switch_timer);
ble_try_switch_timer = 0;
}
}
extern void tws_tx_unsniff_req(void);
void bt_tws_ble_link_switch(void)
{
#if CONFIG_BT_TWS_SNIFF
tws_sniff_controle_check_disable();
tws_tx_unsniff_req();
#endif
ble_try_switch_timer = sys_timer_add(NULL, tws_phone_ble_link_try_switch, 20);
}
//未连接手机时的TWS主从切换
void bt_tws_role_switch()
{
if (!(gtws.state & BT_TWS_SIBLING_CONNECTED)) {
return;
}
if (tws_api_get_role() == TWS_ROLE_SLAVE) {
return;
}
puts("bt_tws_role_switch\n");
bt_tws_delete_pair_timer();
tws_api_cancle_wait_pair();
#if CONFIG_BT_TWS_SNIFF
tws_sniff_controle_check_disable();
tws_tx_unsniff_req();
for (int i = 0; i < 20; i++) {
if (!tws_in_sniff_state()) {
tws_api_role_switch();
break;
}
os_time_dly(4);
}
#else
tws_api_role_switch();
#endif
}
#endif
Reference in New Issue Copy Permalink