1 // Copyright 2015-2016 Espressif Systems (Shanghai) PTE LTD
2 //
3 // Licensed under the Apache License, Version 2.0 (the "License");
4 // you may not use this file except in compliance with the License.
5 // You may obtain a copy of the License at
6
7 // http://www.apache.org/licenses/LICENSE-2.0
8 //
9 // Unless required by applicable law or agreed to in writing, software
10 // distributed under the License is distributed on an "AS IS" BASIS,
11 // WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
12 // See the License for the specific language governing permissions and
13 // limitations under the License.
14
15 /************************************************************************************
16 *
17 * Filename: btc_util.c
18 *
19 * Description: Miscellaneous helper functions
20 *
21 *
22 ***********************************************************************************/
23
24 #include <stdio.h>
25 #include <stdlib.h>
26 #include <string.h>
27 #include <ctype.h>
28
29 #include "btc/btc_util.h"
30 #if (BTA_AV_INCLUDED == 1)
31 #include "bta/bta_av_api.h"
32 #endif ///BTA_AV_INCLUDED == 1
33
34 #if (BTA_AG_INCLUDED == 1)
35 #include "bta/bta_ag_api.h"
36 #endif ///BTA_AG_INCLUDED == 1
37
38 #include "common/bt_defs.h"
39 #include "stack/btm_api.h"
40 #include "bta/bta_api.h"
41
42 /************************************************************************************
43 ** Constants & Macros
44 ************************************************************************************/
45 #define ISDIGIT(a) ((a>='0') && (a<='9'))
46 #define ISXDIGIT(a) (((a>='0') && (a<='9'))||((a>='A') && (a<='F'))||((a>='a') && (a<='f')))
47
48 /************************************************************************************
49 ** Local type definitions
50 ************************************************************************************/
51
52 /************************************************************************************
53 ** Static variables
54 ************************************************************************************/
55
56 /************************************************************************************
57 ** Static functions
58 ************************************************************************************/
59
60 /************************************************************************************
61 ** Externs
62 ************************************************************************************/
63
64 /************************************************************************************
65 ** Functions
66 ************************************************************************************/
67
68 /*****************************************************************************
69 ** Logging helper functions
70 *****************************************************************************/
71 #if(BTA_AV_INCLUDED == 1)
dump_rc_event(UINT8 event)72 const char *dump_rc_event(UINT8 event)
73 {
74 switch (event) {
75 CASE_RETURN_STR(BTA_AV_RC_OPEN_EVT)
76 CASE_RETURN_STR(BTA_AV_RC_CLOSE_EVT)
77 CASE_RETURN_STR(BTA_AV_REMOTE_CMD_EVT)
78 CASE_RETURN_STR(BTA_AV_REMOTE_RSP_EVT)
79 CASE_RETURN_STR(BTA_AV_VENDOR_CMD_EVT)
80 CASE_RETURN_STR(BTA_AV_VENDOR_RSP_EVT)
81 CASE_RETURN_STR(BTA_AV_META_MSG_EVT)
82 CASE_RETURN_STR(BTA_AV_RC_FEAT_EVT)
83 default:
84 return "UNKNOWN_EVENT";
85 }
86 }
87
dump_rc_notification_event_id(UINT8 event_id)88 const char *dump_rc_notification_event_id(UINT8 event_id)
89 {
90 switch (event_id) {
91 CASE_RETURN_STR(AVRC_EVT_PLAY_STATUS_CHANGE)
92 CASE_RETURN_STR(AVRC_EVT_TRACK_CHANGE)
93 CASE_RETURN_STR(AVRC_EVT_TRACK_REACHED_END)
94 CASE_RETURN_STR(AVRC_EVT_TRACK_REACHED_START)
95 CASE_RETURN_STR(AVRC_EVT_PLAY_POS_CHANGED)
96 CASE_RETURN_STR(AVRC_EVT_BATTERY_STATUS_CHANGE)
97 CASE_RETURN_STR(AVRC_EVT_SYSTEM_STATUS_CHANGE)
98 CASE_RETURN_STR(AVRC_EVT_APP_SETTING_CHANGE)
99 CASE_RETURN_STR(AVRC_EVT_VOLUME_CHANGE)
100
101 default:
102 return "Unhandled Event ID";
103 }
104 }
105
dump_rc_pdu(UINT8 pdu)106 const char *dump_rc_pdu(UINT8 pdu)
107 {
108 switch (pdu) {
109 CASE_RETURN_STR(AVRC_PDU_LIST_PLAYER_APP_ATTR)
110 CASE_RETURN_STR(AVRC_PDU_LIST_PLAYER_APP_VALUES)
111 CASE_RETURN_STR(AVRC_PDU_GET_CUR_PLAYER_APP_VALUE)
112 CASE_RETURN_STR(AVRC_PDU_SET_PLAYER_APP_VALUE)
113 CASE_RETURN_STR(AVRC_PDU_GET_PLAYER_APP_ATTR_TEXT)
114 CASE_RETURN_STR(AVRC_PDU_GET_PLAYER_APP_VALUE_TEXT)
115 CASE_RETURN_STR(AVRC_PDU_INFORM_DISPLAY_CHARSET)
116 CASE_RETURN_STR(AVRC_PDU_INFORM_BATTERY_STAT_OF_CT)
117 CASE_RETURN_STR(AVRC_PDU_GET_ELEMENT_ATTR)
118 CASE_RETURN_STR(AVRC_PDU_GET_PLAY_STATUS)
119 CASE_RETURN_STR(AVRC_PDU_REGISTER_NOTIFICATION)
120 CASE_RETURN_STR(AVRC_PDU_REQUEST_CONTINUATION_RSP)
121 CASE_RETURN_STR(AVRC_PDU_ABORT_CONTINUATION_RSP)
122 CASE_RETURN_STR(AVRC_PDU_SET_ABSOLUTE_VOLUME)
123 default:
124 return "Unknown PDU";
125 }
126 }
127 #endif ///BTA_AV_INCLUDED == 1
128
129 #if (BTA_AG_INCLUDED == 1)
dump_hf_conn_state(UINT16 event)130 const char* dump_hf_conn_state(UINT16 event)
131 {
132 switch(event)
133 {
134 CASE_RETURN_STR(ESP_HF_CONNECTION_STATE_DISCONNECTED)
135 CASE_RETURN_STR(ESP_HF_CONNECTION_STATE_CONNECTING)
136 CASE_RETURN_STR(ESP_HF_CONNECTION_STATE_CONNECTED)
137 CASE_RETURN_STR(ESP_HF_CONNECTION_STATE_SLC_CONNECTED)
138 CASE_RETURN_STR(ESP_HF_CONNECTION_STATE_DISCONNECTING)
139 default:
140 return "UNKNOWN MSG ID";
141 }
142 }
143
dump_hf_event(UINT16 event)144 const char* dump_hf_event(UINT16 event)
145 {
146 switch(event)
147 {
148 CASE_RETURN_STR(BTA_AG_ENABLE_EVT)
149 CASE_RETURN_STR(BTA_AG_REGISTER_EVT)
150 CASE_RETURN_STR(BTA_AG_OPEN_EVT)
151 CASE_RETURN_STR(BTA_AG_CLOSE_EVT)
152 CASE_RETURN_STR(BTA_AG_CONN_EVT)
153 CASE_RETURN_STR(BTA_AG_AUDIO_OPEN_EVT)
154 CASE_RETURN_STR(BTA_AG_AUDIO_CLOSE_EVT)
155 CASE_RETURN_STR(BTA_AG_SPK_EVT)
156 CASE_RETURN_STR(BTA_AG_MIC_EVT)
157 CASE_RETURN_STR(BTA_AG_AT_CKPD_EVT)
158 CASE_RETURN_STR(BTA_AG_DISABLE_EVT)
159 #if (BTM_WBS_INCLUDED == 1)
160 CASE_RETURN_STR(BTA_AG_WBS_EVT)
161 #endif
162 CASE_RETURN_STR(BTA_AG_AT_A_EVT)
163 CASE_RETURN_STR(BTA_AG_AT_D_EVT)
164 CASE_RETURN_STR(BTA_AG_AT_CHLD_EVT)
165 CASE_RETURN_STR(BTA_AG_AT_CHUP_EVT)
166 CASE_RETURN_STR(BTA_AG_AT_CIND_EVT)
167 CASE_RETURN_STR(BTA_AG_AT_VTS_EVT)
168 CASE_RETURN_STR(BTA_AG_AT_BINP_EVT)
169 CASE_RETURN_STR(BTA_AG_AT_BLDN_EVT)
170 CASE_RETURN_STR(BTA_AG_AT_BVRA_EVT)
171 CASE_RETURN_STR(BTA_AG_AT_NREC_EVT)
172 CASE_RETURN_STR(BTA_AG_AT_CNUM_EVT)
173 CASE_RETURN_STR(BTA_AG_AT_BTRH_EVT)
174 CASE_RETURN_STR(BTA_AG_AT_CLCC_EVT)
175 CASE_RETURN_STR(BTA_AG_AT_COPS_EVT)
176 CASE_RETURN_STR(BTA_AG_AT_UNAT_EVT)
177 CASE_RETURN_STR(BTA_AG_AT_CBC_EVT)
178 CASE_RETURN_STR(BTA_AG_AT_BAC_EVT)
179 CASE_RETURN_STR(BTA_AG_AT_BCS_EVT)
180
181 default:
182 return "UNKNOWN MSG ID";
183 }
184 }
185
dump_hf_call_state(esp_hf_call_status_t call_state)186 const char* dump_hf_call_state(esp_hf_call_status_t call_state)
187 {
188 switch(call_state)
189 {
190 CASE_RETURN_STR(ESP_HF_CALL_STATUS_NO_CALLS)
191 CASE_RETURN_STR(ESP_HF_CALL_STATUS_CALL_IN_PROGRESS)
192 default:
193 return "UNKNOWN CALL STATE";
194 }
195 }
196
dump_hf_call_setup_state(esp_hf_call_setup_status_t call_setup_state)197 const char* dump_hf_call_setup_state(esp_hf_call_setup_status_t call_setup_state)
198 {
199 switch(call_setup_state)
200 {
201 CASE_RETURN_STR(ESP_HF_CALL_SETUP_STATUS_IDLE)
202 CASE_RETURN_STR(ESP_HF_CALL_SETUP_STATUS_INCOMING)
203 CASE_RETURN_STR(ESP_HF_CALL_SETUP_STATUS_OUTGOING_DIALING)
204 CASE_RETURN_STR(ESP_HF_CALL_SETUP_STATUS_OUTGOING_ALERTING)
205 default:
206 return "UNKNOWN CALL SETUP STATE";
207 }
208 }
209
210 #endif // #if (BTA_AG_INCLUDED == 1)
211
devclass2uint(DEV_CLASS dev_class)212 UINT32 devclass2uint(DEV_CLASS dev_class)
213 {
214 UINT32 cod = 0;
215
216 if (dev_class != NULL) {
217 /* if COD is 0, irrespective of the device type set it to Unclassified device */
218 cod = (dev_class[2]) | (dev_class[1] << 8) | (dev_class[0] << 16);
219 }
220 return cod;
221 }
222
uint2devclass(UINT32 cod,DEV_CLASS dev_class)223 void uint2devclass(UINT32 cod, DEV_CLASS dev_class)
224 {
225 dev_class[2] = (UINT8)cod;
226 dev_class[1] = (UINT8)(cod >> 8);
227 dev_class[0] = (UINT8)(cod >> 16);
228 }
229
230 static const UINT8 base_uuid_be[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00,
231 0x80, 0x00, 0x00, 0x80, 0x5F, 0x9B, 0x34, 0xFB};
232
uuid128_be_to_esp_uuid(esp_bt_uuid_t * u,uint8_t * uuid128)233 void uuid128_be_to_esp_uuid(esp_bt_uuid_t *u, uint8_t* uuid128)
234 {
235 if (memcmp(base_uuid_be+4, uuid128 + 4, 12) != 0) {
236 u->len = ESP_UUID_LEN_128;
237 uint8_t *p_i = uuid128 + ESP_UUID_LEN_128 - 1;
238 uint8_t *p_o = u->uuid.uuid128;
239 uint8_t *p_end = p_o + ESP_UUID_LEN_128;
240 for (; p_o != p_end; *p_o++ = *p_i--)
241 ;
242 } else if (uuid128[0] == 0 && uuid128[1] == 0) {
243 u->len = 2;
244 u->uuid.uuid16 = (uuid128[2] << 8) + uuid128[3];
245 } else {
246 u->len = 4;
247 u->uuid.uuid32 = (uuid128[2] << 8) + uuid128[3];
248 u->uuid.uuid32 += (uuid128[0] << 24) + (uuid128[1] << 16);
249 }
250
251 return;
252 }
253
uuid_to_string_legacy(bt_uuid_t * p_uuid,char * str)254 void uuid_to_string_legacy(bt_uuid_t *p_uuid, char *str)
255 {
256 uint32_t uuid0, uuid4;
257 uint16_t uuid1, uuid2, uuid3, uuid5;
258
259 memcpy(&uuid0, &(p_uuid->uu[0]), 4);
260 memcpy(&uuid1, &(p_uuid->uu[4]), 2);
261 memcpy(&uuid2, &(p_uuid->uu[6]), 2);
262 memcpy(&uuid3, &(p_uuid->uu[8]), 2);
263 memcpy(&uuid4, &(p_uuid->uu[10]), 4);
264 memcpy(&uuid5, &(p_uuid->uu[14]), 2);
265
266 sprintf((char *)str, "%.8x-%.4x-%.4x-%.4x-%.8x%.4x",
267 ntohl(uuid0), ntohs(uuid1),
268 ntohs(uuid2), ntohs(uuid3),
269 ntohl(uuid4), ntohs(uuid5));
270 return;
271 }
272
btc_hci_to_esp_status(uint8_t hci_status)273 esp_bt_status_t btc_hci_to_esp_status(uint8_t hci_status)
274 {
275 esp_bt_status_t esp_status = ESP_BT_STATUS_FAIL;
276 switch(hci_status) {
277 case HCI_SUCCESS:
278 esp_status = ESP_BT_STATUS_SUCCESS;
279 break;
280 case HCI_ERR_HOST_TIMEOUT:
281 esp_status = ESP_BT_STATUS_TIMEOUT;
282 break;
283 case HCI_ERR_ILLEGAL_COMMAND:
284 esp_status = ESP_BT_STATUS_PENDING;
285 break;
286 case HCI_ERR_UNACCEPT_CONN_INTERVAL:
287 esp_status = ESP_BT_STATUS_UNACCEPT_CONN_INTERVAL;
288 break;
289 case HCI_ERR_PARAM_OUT_OF_RANGE:
290 esp_status = ESP_BT_STATUS_PARAM_OUT_OF_RANGE;
291 break;
292 case HCI_ERR_ILLEGAL_PARAMETER_FMT:
293 esp_status = ESP_BT_STATUS_ERR_ILLEGAL_PARAMETER_FMT;
294 break;
295 default:
296 esp_status = ESP_BT_STATUS_FAIL;
297 break;
298 }
299
300 return esp_status;
301 }
302
btc_btm_status_to_esp_status(uint8_t btm_status)303 esp_bt_status_t btc_btm_status_to_esp_status (uint8_t btm_status)
304 {
305 esp_bt_status_t esp_status = ESP_BT_STATUS_FAIL;
306 switch(btm_status){
307 case BTM_SUCCESS:
308 esp_status = ESP_BT_STATUS_SUCCESS;
309 break;
310 case BTM_BUSY:
311 esp_status = ESP_BT_STATUS_BUSY;
312 break;
313 case BTM_NO_RESOURCES:
314 esp_status = ESP_BT_STATUS_NOMEM;
315 break;
316 case BTM_ILLEGAL_VALUE:
317 esp_status = ESP_BT_STATUS_PARM_INVALID;
318 break;
319 case BTM_ERR_PROCESSING:
320 esp_status = ESP_BT_STATUS_PENDING;
321 break;
322 case BTM_PEER_LE_DATA_LEN_UNSUPPORTED:
323 esp_status = ESP_BT_STATUS_PEER_LE_DATA_LEN_UNSUPPORTED;
324 break;
325 case BTM_CONTROL_LE_DATA_LEN_UNSUPPORTED:
326 esp_status = ESP_BT_STATUS_CONTROL_LE_DATA_LEN_UNSUPPORTED;
327 break;
328 case BTM_SET_PRIVACY_SUCCESS:
329 esp_status = ESP_BT_STATUS_SUCCESS;
330 break;
331 case BTM_SET_PRIVACY_FAIL:
332 esp_status = ESP_BT_STATUS_FAIL;
333 break;
334 default:
335 esp_status = ESP_BT_STATUS_FAIL;
336 break;
337 }
338
339 return esp_status;
340 }
341
btc_bta_status_to_esp_status(uint8_t bta_status)342 esp_bt_status_t btc_bta_status_to_esp_status (uint8_t bta_status)
343 {
344 esp_bt_status_t esp_status = ESP_BT_STATUS_FAIL;
345 switch(bta_status){
346 case BTA_SUCCESS:
347 esp_status = ESP_BT_STATUS_SUCCESS;
348 break;
349 case BTA_FAILURE:
350 esp_status = ESP_BT_STATUS_FAIL;
351 break;
352 case BTA_PENDING:
353 esp_status = ESP_BT_STATUS_PENDING;
354 break;
355 case BTA_BUSY:
356 esp_status = ESP_BT_STATUS_BUSY;
357 break;
358 case BTA_NO_RESOURCES:
359 esp_status = ESP_BT_STATUS_NOMEM;
360 break;
361 case BTA_WRONG_MODE:
362 esp_status = ESP_BT_STATUS_NOT_READY;
363 break;
364 case BTA_EIR_TOO_LARGE:
365 esp_status = ESP_BT_STATUS_EIR_TOO_LARGE;
366 break;
367 default:
368 esp_status = ESP_BT_STATUS_FAIL;
369 break;
370 }
371
372 return esp_status;
373 }
374