Use the GPIO level to set the TWS side

This commit is contained in:
Ben V. Brown 2022-12-28 21:29:29 +11:00
parent 5c119d048c
commit 9a9ad05100
1 changed files with 17 additions and 13 deletions

View File

@ -663,6 +663,7 @@ static APP_TWS_SIDE_T app_tws_side = EAR_SIDE_UNKNOWN;
void app_tws_set_side(APP_TWS_SIDE_T side) void app_tws_set_side(APP_TWS_SIDE_T side)
{ {
ASSERT((EAR_SIDE_LEFT == side) || (EAR_SIDE_RIGHT == side), "Error: setting invalid side"); ASSERT((EAR_SIDE_LEFT == side) || (EAR_SIDE_RIGHT == side), "Error: setting invalid side");
TRACE(1,"Set TWS side to %d",side);
app_tws_side = side; app_tws_side = side;
} }
@ -681,22 +682,25 @@ bool app_tws_is_unknown_side(void)
return (app_tws_side == EAR_SIDE_UNKNOWN); return (app_tws_side == EAR_SIDE_UNKNOWN);
} }
void app_tws_set_side_from_addr(uint8_t *addr) // void app_tws_set_side_from_addr(uint8_t *addr)
{ // {
ASSERT(addr, "Error: address invalid"); // ASSERT(addr, "Error: address invalid");
if (addr[0] & 0x1) { // if (addr[0] & 0x1) {
app_tws_set_side(EAR_SIDE_RIGHT); // app_tws_set_side(EAR_SIDE_RIGHT);
TRACE(0, "Right earbud"); // TRACE(0, "Right earbud");
} else { // } else {
app_tws_set_side(EAR_SIDE_LEFT); // app_tws_set_side(EAR_SIDE_LEFT);
TRACE(0, "Left earbud"); // TRACE(0, "Left earbud");
} // }
} // }
void app_tws_set_side_from_gpio(void) void app_tws_set_side_from_gpio(void)
{ {
if (tgt_tws_get_channel_is_right()){
app_tws_set_side(EAR_SIDE_RIGHT);
}else {
app_tws_set_side(EAR_SIDE_LEFT);
}
} }
#endif #endif