1 /* 2 * Copyright (C) 2014 BlueKitchen GmbH 3 * 4 * Redistribution and use in source and binary forms, with or without 5 * modification, are permitted provided that the following conditions 6 * are met: 7 * 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 3. Neither the name of the copyright holders nor the names of 14 * contributors may be used to endorse or promote products derived 15 * from this software without specific prior written permission. 16 * 4. Any redistribution, use, or modification is done solely for 17 * personal benefit and not for any commercial purpose or for 18 * monetary gain. 19 * 20 * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 21 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 22 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 23 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BLUEKITCHEN 24 * GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 25 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 26 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 27 * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 28 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 29 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 30 * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 31 * SUCH DAMAGE. 32 * 33 * Please inquire about commercial licensing options at 34 * [email protected] 35 * 36 */ 37 38 #define BTSTACK_FILE__ "pbap_client.c" 39 40 #include "btstack_config.h" 41 42 #include <stdint.h> 43 #include <string.h> 44 45 #include "hci_cmd.h" 46 #include "btstack_run_loop.h" 47 #include "btstack_debug.h" 48 #include "hci.h" 49 #include "btstack_memory.h" 50 #include "hci_dump.h" 51 #include "l2cap.h" 52 #include "bluetooth_sdp.h" 53 #include "classic/sdp_client_rfcomm.h" 54 #include "btstack_event.h" 55 #include "md5.h" 56 57 #include "classic/obex.h" 58 #include "classic/obex_parser.h" 59 #include "classic/goep_client.h" 60 #include "classic/pbap.h" 61 #include "classic/pbap_client.h" 62 63 // 796135f0-f0c5-11d8-0966- 0800200c9a66 64 static const uint8_t pbap_uuid[] = { 0x79, 0x61, 0x35, 0xf0, 0xf0, 0xc5, 0x11, 0xd8, 0x09, 0x66, 0x08, 0x00, 0x20, 0x0c, 0x9a, 0x66}; 65 66 const char * pbap_phonebook_type = "x-bt/phonebook"; 67 const char * pbap_vcard_listing_type = "x-bt/vcard-listing"; 68 const char * pbap_vcard_entry_type = "x-bt/vcard"; 69 70 const char * pbap_vcard_listing_name = "pb"; 71 72 // used for MD5 73 static const uint8_t colon = (uint8_t) ':'; 74 75 static uint32_t pbap_client_supported_features; 76 77 static bool pbap_client_singleton_used; 78 79 static btstack_linked_list_t pbap_clients; 80 81 // emit events 82 static void pbap_client_emit_connected_event(pbap_client_t * context, uint8_t status){ 83 uint8_t event[15]; 84 int pos = 0; 85 event[pos++] = HCI_EVENT_PBAP_META; 86 pos++; // skip len 87 event[pos++] = PBAP_SUBEVENT_CONNECTION_OPENED; 88 little_endian_store_16(event,pos,context->goep_cid); 89 pos+=2; 90 event[pos++] = status; 91 (void)memcpy(&event[pos], context->bd_addr, 6); 92 pos += 6; 93 little_endian_store_16(event,pos,context->con_handle); 94 pos += 2; 95 event[pos++] = 0; 96 event[1] = pos - 2; 97 if (pos != sizeof(event)) log_error("goep_client_emit_connected_event size %u", pos); 98 context->client_handler(HCI_EVENT_PACKET, context->goep_cid, &event[0], pos); 99 } 100 101 static void pbap_client_emit_connection_closed_event(pbap_client_t * context){ 102 uint8_t event[5]; 103 int pos = 0; 104 event[pos++] = HCI_EVENT_PBAP_META; 105 pos++; // skip len 106 event[pos++] = PBAP_SUBEVENT_CONNECTION_CLOSED; 107 little_endian_store_16(event,pos,context->goep_cid); 108 pos+=2; 109 event[1] = pos - 2; 110 if (pos != sizeof(event)) log_error("pbap_client_emit_connection_closed_event size %u", pos); 111 context->client_handler(HCI_EVENT_PACKET, context->goep_cid, &event[0], pos); 112 } 113 114 static void pbap_client_emit_operation_complete_event(pbap_client_t * context, uint8_t status){ 115 uint8_t event[6]; 116 int pos = 0; 117 event[pos++] = HCI_EVENT_PBAP_META; 118 pos++; // skip len 119 event[pos++] = PBAP_SUBEVENT_OPERATION_COMPLETED; 120 little_endian_store_16(event,pos,context->goep_cid); 121 pos+=2; 122 event[pos++]= status; 123 event[1] = pos - 2; 124 if (pos != sizeof(event)) log_error("pbap_client_emit_can_send_now_event size %u", pos); 125 context->client_handler(HCI_EVENT_PACKET, context->goep_cid, &event[0], pos); 126 } 127 128 static void pbap_client_emit_phonebook_size_event(pbap_client_t * context, uint8_t status, uint16_t phonebook_size){ 129 uint8_t event[8]; 130 int pos = 0; 131 event[pos++] = HCI_EVENT_PBAP_META; 132 pos++; // skip len 133 event[pos++] = PBAP_SUBEVENT_PHONEBOOK_SIZE; 134 little_endian_store_16(event,pos,context->goep_cid); 135 pos+=2; 136 event[pos++] = status; 137 little_endian_store_16(event,pos, phonebook_size); 138 pos+=2; 139 event[1] = pos - 2; 140 if (pos != sizeof(event)) log_error("pbap_client_emit_phonebook_size_event size %u", pos); 141 context->client_handler(HCI_EVENT_PACKET, context->goep_cid, &event[0], pos); 142 } 143 144 static void pbap_client_emit_authentication_event(pbap_client_t * context, uint8_t options){ 145 // split options 146 uint8_t user_id_required = (options & 1) ? 1 : 0; 147 uint8_t full_access = (options & 2) ? 1 : 0; 148 149 uint8_t event[7]; 150 int pos = 0; 151 event[pos++] = HCI_EVENT_PBAP_META; 152 pos++; // skip len 153 event[pos++] = PBAP_SUBEVENT_AUTHENTICATION_REQUEST; 154 little_endian_store_16(event,pos,context->goep_cid); 155 pos+=2; 156 event[pos++] = user_id_required; 157 event[pos++] = full_access; 158 if (pos != sizeof(event)) log_error("pbap_client_emit_authentication_event size %u", pos); 159 context->client_handler(HCI_EVENT_PACKET, context->goep_cid, &event[0], pos); 160 } 161 162 static void pbap_client_emit_card_result_event(pbap_client_t * context, const char * name, const char * handle){ 163 uint8_t event[5 + PBAP_MAX_NAME_LEN + PBAP_MAX_HANDLE_LEN]; 164 int pos = 0; 165 event[pos++] = HCI_EVENT_PBAP_META; 166 pos++; // skip len 167 event[pos++] = PBAP_SUBEVENT_CARD_RESULT; 168 little_endian_store_16(event,pos,context->goep_cid); 169 pos+=2; 170 int name_len = btstack_min(PBAP_MAX_NAME_LEN, (uint16_t) strlen(name)); 171 event[pos++] = name_len; 172 (void)memcpy(&event[pos], name, name_len); 173 pos += name_len; 174 int handle_len = btstack_min(PBAP_MAX_HANDLE_LEN, (uint16_t) strlen(handle)); 175 event[pos++] = handle_len; 176 (void)memcpy(&event[pos], handle, handle_len); 177 pos += handle_len; 178 event[1] = pos - 2; 179 context->client_handler(HCI_EVENT_PACKET, context->goep_cid, &event[0], pos); 180 } 181 182 static pbap_client_t * pbap_client_for_cid(uint16_t cid){ 183 btstack_linked_list_iterator_t it; 184 btstack_linked_list_iterator_init(&it, &pbap_clients); 185 while (btstack_linked_list_iterator_has_next(&it)){ 186 pbap_client_t * client = (pbap_client_t *) btstack_linked_list_iterator_next(&it); 187 if (client->goep_cid == cid){ 188 return client; 189 } 190 } 191 return NULL; 192 } 193 194 static void pbap_client_finalize(pbap_client_t *client) { 195 client->state = PBAP_CLIENT_INIT; 196 btstack_linked_list_remove(&pbap_clients, (btstack_linked_item_t*) client); 197 } 198 199 static void pbap_client_vcard_listing_init_parser(pbap_client_t * client){ 200 yxml_init(&client->xml_parser, client->xml_buffer, sizeof(client->xml_buffer)); 201 client->parser_card_found = false; 202 client->parser_name_found = false; 203 client->parser_handle_found = false; 204 } 205 206 static void pbap_client_phonebook_size_parser_init(pbap_client_phonebook_size_parser_t * phonebook_size_parer){ 207 memset(phonebook_size_parer, 0, sizeof(pbap_client_phonebook_size_parser_t)); 208 } 209 210 static void pbap_client_phonebook_size_parser_process_data(pbap_client_phonebook_size_parser_t * phonebook_size_parser, const uint8_t * data_buffer, uint16_t data_len){ 211 while (data_len){ 212 uint16_t bytes_to_consume = 1; 213 switch(phonebook_size_parser->state){ 214 case PBAP_CLIENT_PHONEBOOK_SIZE_PARSER_STATE_INVALID: 215 return; 216 case PBAP_CLIENT_PHONEBOOK_SIZE_PARSER_STATE_W4_TYPE: 217 phonebook_size_parser->type = *data_buffer; 218 phonebook_size_parser->state = PBAP_CLIENT_PHONEBOOK_SIZE_PARSER_STATE_W4_LEN; 219 break; 220 case PBAP_CLIENT_PHONEBOOK_SIZE_PARSER_STATE_W4_LEN: 221 phonebook_size_parser->len = *data_buffer; 222 phonebook_size_parser->state = PBAP_CLIENT_PHONEBOOK_SIZE_PARSER_STATE_W4_VALUE; 223 switch (phonebook_size_parser->type){ 224 case PBAP_APPLICATION_PARAMETER_PHONEBOOK_SIZE: 225 if (phonebook_size_parser->len != 2){ 226 phonebook_size_parser->state = PBAP_CLIENT_PHONEBOOK_SIZE_PARSER_STATE_INVALID; 227 return; 228 } 229 break; 230 default: 231 break; 232 } 233 break; 234 case PBAP_CLIENT_PHONEBOOK_SIZE_PARSER_STATE_W4_VALUE: 235 bytes_to_consume = btstack_min(phonebook_size_parser->len - phonebook_size_parser->pos, data_len); 236 switch (phonebook_size_parser->type){ 237 case PBAP_APPLICATION_PARAMETER_PHONEBOOK_SIZE: 238 memcpy(&phonebook_size_parser->size_buffer[phonebook_size_parser->pos], data_buffer, bytes_to_consume); 239 break; 240 default: 241 // ignore data 242 break; 243 } 244 phonebook_size_parser->pos += bytes_to_consume; 245 if (phonebook_size_parser->pos == phonebook_size_parser->len){ 246 phonebook_size_parser->state = PBAP_CLIENT_PHONEBOOK_SIZE_PARSER_STATE_W4_TYPE; 247 switch (phonebook_size_parser->type){ 248 case PBAP_APPLICATION_PARAMETER_PHONEBOOK_SIZE: 249 phonebook_size_parser->have_size = true; 250 break; 251 default: 252 break; 253 } 254 } 255 break; 256 default: 257 break; 258 } 259 data_buffer += bytes_to_consume; 260 data_len -= bytes_to_consume; 261 } 262 } 263 264 static void obex_auth_parser_init(obex_auth_parser_t * auth_parser){ 265 memset(auth_parser, 0, sizeof(obex_auth_parser_t)); 266 } 267 268 static void obex_auth_parser_process_data(obex_auth_parser_t * auth_parser, const uint8_t * data_buffer, uint16_t data_len){ 269 while (data_len){ 270 uint16_t bytes_to_consume = 1; 271 switch(auth_parser->state){ 272 case OBEX_AUTH_PARSER_STATE_INVALID: 273 return; 274 case OBEX_AUTH_PARSER_STATE_W4_TYPE: 275 auth_parser->type = *data_buffer; 276 auth_parser->state = OBEX_AUTH_PARSER_STATE_W4_LEN; 277 break; 278 case OBEX_AUTH_PARSER_STATE_W4_LEN: 279 auth_parser->len = *data_buffer; 280 switch (auth_parser->type){ 281 case 0: 282 if (auth_parser->len != 0x10){ 283 auth_parser->state = OBEX_AUTH_PARSER_STATE_INVALID; 284 return; 285 } 286 break; 287 case 1: 288 if (auth_parser->len != 0x01){ 289 auth_parser->state = OBEX_AUTH_PARSER_STATE_INVALID; 290 return; 291 } 292 break; 293 case 2: 294 // TODO: handle charset 295 // charset_code = challenge_data[i]; 296 break; 297 default: 298 break; 299 } 300 auth_parser->state = OBEX_AUTH_PARSER_STATE_W4_VALUE; 301 break; 302 case OBEX_AUTH_PARSER_STATE_W4_VALUE: 303 bytes_to_consume = btstack_min(auth_parser->len - auth_parser->pos, data_len); 304 switch (auth_parser->type){ 305 case 0: 306 memcpy(&auth_parser->authentication_nonce[auth_parser->pos], data_buffer, bytes_to_consume); 307 break; 308 case 1: 309 auth_parser->authentication_options = *data_buffer; 310 break; 311 default: 312 // ignore 313 break; 314 } 315 auth_parser->pos += bytes_to_consume; 316 if (auth_parser->pos == auth_parser->len){ 317 auth_parser->state = OBEX_AUTH_PARSER_STATE_W4_TYPE; 318 } 319 break; 320 default: 321 btstack_unreachable(); 322 break; 323 } 324 data_buffer += bytes_to_consume; 325 data_len -= bytes_to_consume; 326 } 327 } 328 329 static void obex_srm_init(obex_srm_t * obex_srm){ 330 obex_srm->srm_value = OBEX_SRM_DISABLE; 331 obex_srm->srmp_value = OBEX_SRMP_NEXT; 332 } 333 static void pbap_client_yml_append_character(yxml_t * xml_parser, char * buffer, uint16_t buffer_size){ 334 // "In UTF-8, characters from the U+0000..U+10FFFF range (the UTF-16 accessible range) are encoded using sequences of 1 to 4 octets." 335 uint16_t char_len = (uint16_t) strlen(xml_parser->data); 336 btstack_assert(char_len <= 4); 337 uint16_t dest_len = (uint16_t) strlen(buffer); 338 uint16_t zero_pos = dest_len + char_len; 339 if (zero_pos >= buffer_size) return; 340 memcpy(&buffer[dest_len], xml_parser->data, char_len); 341 buffer[zero_pos] = '\0'; 342 } 343 344 static void pbap_client_process_vcard_list_body(pbap_client_t *client, const uint8_t *data, uint16_t data_len) { 345 346 while (data_len--) { 347 yxml_ret_t r = yxml_parse(&client->xml_parser, *data++); 348 switch (r) { 349 case YXML_ELEMSTART: 350 client->parser_card_found = strcmp("card", client->xml_parser.elem) == 0; 351 break; 352 case YXML_ELEMEND: 353 if (client->parser_card_found) { 354 pbap_client_emit_card_result_event(client, client->parser_name, 355 client->parser_handle); 356 } 357 client->parser_card_found = false; 358 break; 359 case YXML_ATTRSTART: 360 if (!client->parser_card_found) break; 361 if (strcmp("name", client->xml_parser.attr) == 0) { 362 client->parser_name_found = true; 363 client->parser_name[0] = 0; 364 break; 365 } 366 if (strcmp("handle", client->xml_parser.attr) == 0) { 367 client->parser_handle_found = true; 368 client->parser_handle[0] = 0; 369 break; 370 } 371 break; 372 case YXML_ATTRVAL: 373 if (client->parser_name_found) { 374 pbap_client_yml_append_character(&client->xml_parser, 375 client->parser_name, 376 sizeof(client->parser_name)); 377 break; 378 } 379 if (client->parser_handle_found) { 380 pbap_client_yml_append_character(&client->xml_parser, 381 client->parser_handle, 382 sizeof(client->parser_handle)); 383 break; 384 } 385 break; 386 case YXML_ATTREND: 387 client->parser_name_found = false; 388 client->parser_handle_found = false; 389 break; 390 default: 391 break; 392 } 393 } 394 } 395 396 static void pbap_client_parser_callback_connect(void * user_data, uint8_t header_id, uint16_t total_len, uint16_t data_offset, const uint8_t * data_buffer, uint16_t data_len){ 397 pbap_client_t * client = (pbap_client_t *) user_data; 398 switch (header_id){ 399 case OBEX_HEADER_CONNECTION_ID: 400 if (obex_parser_header_store(client->obex_header_buffer, sizeof(client->obex_header_buffer), total_len, data_offset, data_buffer, data_len) == OBEX_PARSER_HEADER_COMPLETE){ 401 goep_client_set_connection_id(client->goep_cid, big_endian_read_32(client->obex_header_buffer, 0)); 402 } 403 break; 404 case OBEX_HEADER_AUTHENTICATION_CHALLENGE: 405 obex_auth_parser_process_data(&client->obex_auth_parser, data_buffer, data_len); 406 break; 407 default: 408 break; 409 } 410 } 411 412 static void pbap_client_parser_callback_get_phonebook_size(void * user_data, uint8_t header_id, uint16_t total_len, uint16_t data_offset, const uint8_t * data_buffer, uint16_t data_len){ 413 UNUSED(total_len); 414 UNUSED(data_offset); 415 pbap_client_t *client = (pbap_client_t *) user_data; 416 switch (header_id) { 417 case OBEX_HEADER_APPLICATION_PARAMETERS: 418 pbap_client_phonebook_size_parser_process_data(&client->phonebook_size_parser, data_buffer, data_len); 419 break; 420 default: 421 break; 422 } 423 } 424 425 static void pbap_client_parser_callback_get_operation(void * user_data, uint8_t header_id, uint16_t total_len, uint16_t data_offset, const uint8_t * data_buffer, uint16_t data_len){ 426 pbap_client_t *client = (pbap_client_t *) user_data; 427 switch (header_id) { 428 case OBEX_HEADER_SINGLE_RESPONSE_MODE: 429 obex_parser_header_store(&client->obex_srm.srm_value, 1, total_len, data_offset, data_buffer, data_len); 430 break; 431 case OBEX_HEADER_SINGLE_RESPONSE_MODE_PARAMETER: 432 obex_parser_header_store(&client->obex_srm.srmp_value, 1, total_len, data_offset, data_buffer, data_len); 433 break; 434 case OBEX_HEADER_BODY: 435 case OBEX_HEADER_END_OF_BODY: 436 switch(client->state){ 437 case PBAP_CLIENT_W4_PHONEBOOK: 438 case PBAP_CLIENT_W4_GET_CARD_ENTRY_COMPLETE: 439 client->client_handler(PBAP_DATA_PACKET, client->goep_cid, (uint8_t *) data_buffer, data_len); 440 if (data_offset + data_len == total_len){ 441 client->flow_wait_for_user = true; 442 } 443 break; 444 case PBAP_CLIENT_W4_GET_CARD_LIST_COMPLETE: 445 pbap_client_process_vcard_list_body(client, data_buffer, data_len); 446 break; 447 default: 448 btstack_unreachable(); 449 break; 450 } 451 break; 452 default: 453 // ignore other headers 454 break; 455 } 456 } 457 458 static uint16_t pbap_client_application_params_add_vcard_selector(const pbap_client_t * client, uint8_t * application_parameters){ 459 uint16_t pos = 0; 460 if (client->vcard_selector_supported){ 461 // vCard Selector 462 if (client->vcard_selector){ 463 application_parameters[pos++] = PBAP_APPLICATION_PARAMETER_VCARD_SELECTOR; 464 application_parameters[pos++] = 8; 465 memset(&application_parameters[pos], 0, 4); 466 pos += 4; 467 big_endian_store_32(application_parameters, pos, client->vcard_selector); 468 pos += 4; 469 } 470 // vCard Selector Operator 471 if (client->vcard_selector_operator != PBAP_VCARD_SELECTOR_OPERATOR_OR){ 472 application_parameters[pos++] = PBAP_APPLICATION_PARAMETER_VCARD_SELECTOR_OPERATOR; 473 application_parameters[pos++] = 1; 474 application_parameters[pos++] = client->vcard_selector_operator; 475 } 476 } 477 return pos; 478 } 479 480 static uint16_t pbap_client_application_params_add_max_list_count(const pbap_client_t * client, uint8_t * application_parameters, uint16_t max_count){ 481 UNUSED(client); 482 uint16_t pos = 0; 483 application_parameters[pos++] = PBAP_APPLICATION_PARAMETER_MAX_LIST_COUNT; 484 application_parameters[pos++] = 2; 485 big_endian_store_16(application_parameters, 2, max_count); 486 pos += 2; 487 return pos; 488 } 489 490 static uint16_t pbap_client_application_params_add_list_start_offset(const pbap_client_t * client, uint8_t * application_parameters, uint16_t list_start_offset){ 491 uint16_t pos = 0; 492 if (client->list_start_offset != 0){ 493 application_parameters[pos++] = PBAP_APPLICATION_PARAMETER_LIST_START_OFFSET; 494 application_parameters[pos++] = 2; 495 big_endian_store_16(application_parameters, 2, list_start_offset); 496 pos += 2; 497 } 498 return pos; 499 } 500 501 // max size: PBAP_MAX_PHONE_NUMBER_LEN + 5 502 static uint16_t pbap_client_application_params_add_phone_number(const pbap_client_t * client, uint8_t * application_parameters){ 503 uint16_t pos = 0; 504 if (client->phone_number){ 505 // Search by phone number 506 uint16_t phone_number_len = btstack_min(PBAP_MAX_PHONE_NUMBER_LEN, (uint16_t) strlen(client->phone_number)); 507 application_parameters[pos++] = PBAP_APPLICATION_PARAMETER_SEARCH_VALUE; 508 btstack_assert(phone_number_len <= 255); 509 application_parameters[pos++] = (uint8_t) phone_number_len; 510 (void)memcpy(&application_parameters[pos], 511 client->phone_number, phone_number_len); 512 pos += phone_number_len; 513 application_parameters[pos++] = PBAP_APPLICATION_PARAMETER_SEARCH_PROPERTY; 514 application_parameters[pos++] = 1; 515 application_parameters[pos++] = 0x01; // Number 516 } 517 return pos; 518 } 519 520 static uint16_t pbap_client_application_params_add_property_selector(const pbap_client_t * client, uint8_t * application_parameters){ 521 // TODO: support format 522 uint16_t pos = 0; 523 uint32_t property_selector_lower = client->property_selector; 524 if (client->vcard_name != NULL){ 525 if (strncmp(client->vcard_name, "X-BT-UID:", 9) == 0) { 526 property_selector_lower |= 1U << 31; 527 } 528 if (strncmp(client->vcard_name, "X-BT-UCI:", 9) == 0) { 529 property_selector_lower |= 1U << 30; 530 } 531 } 532 if (property_selector_lower != 0){ 533 application_parameters[pos++] = PBAP_APPLICATION_PARAMETER_PROPERTY_SELECTOR; 534 application_parameters[pos++] = 8; 535 big_endian_store_32(application_parameters, pos, 0); // upper 32-bits are reserved/unused so far 536 pos += 4; 537 big_endian_store_32(application_parameters, pos, property_selector_lower); 538 pos += 4; 539 } 540 return pos; 541 } 542 543 // Mandatory if the PSE advertises a PbapSupportedFeatures attribute in its SDP record, else excluded. 544 static uint16_t pbap_client_application_parameters_add_supported_features(const pbap_client_t * client, uint8_t *application_parameters) { 545 uint16_t pos = 0; 546 if (goep_client_get_pbap_supported_features(client->goep_cid) != PBAP_FEATURES_NOT_PRESENT){ 547 application_parameters[pos++] = PBAP_APPLICATION_PARAMETER_PBAP_SUPPORTED_FEATURES; 548 application_parameters[pos++] = 4; 549 big_endian_store_32(application_parameters, 2, pbap_client_supported_features); 550 pos += 4; 551 } 552 return pos; 553 } 554 555 static void pbap_client_add_application_parameters(const pbap_client_t * client, uint8_t * application_parameters, uint16_t len){ 556 if (len > 0){ 557 goep_client_header_add_application_parameters(client->goep_cid, &application_parameters[0], len); 558 } 559 } 560 561 static void pbap_client_prepare_srm_header(pbap_client_t * client){ 562 if (!client->flow_control_enabled && goep_client_version_20_or_higher(client->goep_cid)){ 563 goep_client_header_add_srm_enable(client->goep_cid); 564 client->srm_state = SRM_W4_CONFIRM; 565 } 566 } 567 568 static void pbap_client_prepare_get_operation(pbap_client_t * client){ 569 obex_parser_init_for_response(&client->obex_parser, OBEX_OPCODE_GET, pbap_client_parser_callback_get_operation, client); 570 obex_srm_init(&client->obex_srm); 571 client->obex_parser_waiting_for_response = true; 572 } 573 574 static void pbap_handle_can_send_now(pbap_client_t *pbap_client) { 575 uint16_t path_element_start; 576 uint16_t path_element_len; 577 const char * path_element; 578 uint8_t application_parameters[PBAP_MAX_PHONE_NUMBER_LEN + 10]; 579 uint8_t challenge_response[36]; 580 uint16_t pos; 581 582 MD5_CTX md5_ctx; 583 584 if (pbap_client->abort_operation){ 585 pbap_client->abort_operation = 0; 586 // prepare request 587 goep_client_request_create_abort(pbap_client->goep_cid); 588 // state 589 pbap_client->state = PBAP_CLIENT_W4_ABORT_COMPLETE; 590 // prepare response 591 obex_parser_init_for_response(&pbap_client->obex_parser, OBEX_OPCODE_ABORT, NULL, pbap_client); 592 obex_srm_init(&pbap_client->obex_srm); 593 pbap_client->obex_parser_waiting_for_response = true; 594 // send packet 595 goep_client_execute(pbap_client->goep_cid); 596 return; 597 } 598 599 switch (pbap_client->state){ 600 case PBAP_CLIENT_W2_SEND_CONNECT_REQUEST: 601 // prepare request 602 goep_client_request_create_connect(pbap_client->goep_cid, OBEX_VERSION, 0, OBEX_MAX_PACKETLEN_DEFAULT); 603 goep_client_header_add_target(pbap_client->goep_cid, pbap_uuid, 16); 604 pos = 0; 605 pos += pbap_client_application_parameters_add_supported_features(pbap_client, &application_parameters[pos]); 606 pbap_client_add_application_parameters(pbap_client, application_parameters, pos); 607 // state 608 pbap_client->state = PBAP_CLIENT_W4_CONNECT_RESPONSE; 609 // prepare response 610 obex_parser_init_for_response(&pbap_client->obex_parser, OBEX_OPCODE_CONNECT, pbap_client_parser_callback_connect, pbap_client); 611 obex_auth_parser_init(&pbap_client->obex_auth_parser); 612 obex_srm_init(&pbap_client->obex_srm); 613 pbap_client->obex_parser_waiting_for_response = true; 614 // send packet 615 goep_client_execute(pbap_client->goep_cid); 616 break; 617 case PBAP_CLIENT_W2_SEND_AUTHENTICATED_CONNECT: 618 // prepare request 619 goep_client_request_create_connect(pbap_client->goep_cid, OBEX_VERSION, 0, OBEX_MAX_PACKETLEN_DEFAULT); 620 goep_client_header_add_target(pbap_client->goep_cid, pbap_uuid, 16); 621 // setup authentication challenge response 622 pos = 0; 623 challenge_response[pos++] = 0; // Tag Digest 624 challenge_response[pos++] = 16; // Len 625 // calculate md5 626 MD5_Init(&md5_ctx); 627 MD5_Update(&md5_ctx, pbap_client->obex_auth_parser.authentication_nonce, 16); 628 MD5_Update(&md5_ctx, &colon, 1); 629 MD5_Update(&md5_ctx, pbap_client->authentication_password, (uint16_t) strlen(pbap_client->authentication_password)); 630 MD5_Final(&challenge_response[pos], &md5_ctx); 631 pos += 16; 632 challenge_response[pos++] = 2; // Tag Nonce 633 challenge_response[pos++] = 16; // Len 634 (void)memcpy(&challenge_response[pos], pbap_client->obex_auth_parser.authentication_nonce, 16); 635 pos += 16; 636 goep_client_header_add_challenge_response(pbap_client->goep_cid, challenge_response, pos); 637 // state 638 pbap_client->state = PBAP_CLIENT_W4_CONNECT_RESPONSE; 639 // prepare response 640 obex_parser_init_for_response(&pbap_client->obex_parser, OBEX_OPCODE_CONNECT, pbap_client_parser_callback_connect, pbap_client); 641 obex_srm_init(&pbap_client->obex_srm); 642 pbap_client->obex_parser_waiting_for_response = true; 643 // send packet 644 goep_client_execute(pbap_client->goep_cid); 645 break; 646 case PBAP_CLIENT_W2_SEND_DISCONNECT_REQUEST: 647 // prepare request 648 goep_client_request_create_disconnect(pbap_client->goep_cid); 649 // state 650 pbap_client->state = PBAP_CLIENT_W4_DISCONNECT_RESPONSE; 651 // prepare response 652 obex_parser_init_for_response(&pbap_client->obex_parser, OBEX_OPCODE_DISCONNECT, NULL, pbap_client); 653 obex_srm_init(&pbap_client->obex_srm); 654 pbap_client->obex_parser_waiting_for_response = true; 655 // send packet 656 goep_client_execute(pbap_client->goep_cid); 657 return; 658 case PBAP_CLIENT_W2_GET_PHONEBOOK_SIZE: 659 // prepare request 660 goep_client_request_create_get(pbap_client->goep_cid); 661 pbap_client_prepare_srm_header(pbap_client); 662 goep_client_header_add_name(pbap_client->goep_cid, pbap_client->phonebook_path); 663 goep_client_header_add_type(pbap_client->goep_cid, pbap_phonebook_type); 664 665 pos = 0; 666 pos += pbap_client_application_params_add_vcard_selector(pbap_client, &application_parameters[pos]); 667 // just get size 668 pos += pbap_client_application_params_add_max_list_count(pbap_client, &application_parameters[pos], 0); 669 pbap_client_add_application_parameters(pbap_client, application_parameters, pos); 670 671 // state 672 pbap_client->state = PBAP_CLIENT_W4_GET_PHONEBOOK_SIZE_COMPLETE; 673 // prepare response 674 obex_parser_init_for_response(&pbap_client->obex_parser, OBEX_OPCODE_GET, pbap_client_parser_callback_get_phonebook_size, pbap_client); 675 obex_srm_init(&pbap_client->obex_srm); 676 pbap_client_phonebook_size_parser_init(&pbap_client->phonebook_size_parser); 677 pbap_client->obex_parser_waiting_for_response = true; 678 // send packet 679 goep_client_execute(pbap_client->goep_cid); 680 break; 681 case PBAP_CLIENT_W2_PULL_PHONEBOOK: 682 // prepare request 683 goep_client_request_create_get(pbap_client->goep_cid); 684 if (pbap_client->request_number == 0){ 685 pbap_client_prepare_srm_header(pbap_client); 686 goep_client_header_add_name(pbap_client->goep_cid, pbap_client->phonebook_path); 687 goep_client_header_add_type(pbap_client->goep_cid, pbap_phonebook_type); 688 689 pos = 0; 690 pos += pbap_client_application_params_add_property_selector(pbap_client, &application_parameters[pos]); 691 if (pbap_client->max_list_count){ 692 pos += pbap_client_application_params_add_max_list_count(pbap_client, &application_parameters[pos], pbap_client->max_list_count); 693 } 694 pos += pbap_client_application_params_add_list_start_offset (pbap_client, &application_parameters[pos], pbap_client->list_start_offset); 695 pos += pbap_client_application_params_add_vcard_selector(pbap_client, &application_parameters[pos]); 696 pbap_client_add_application_parameters(pbap_client, application_parameters, pos); 697 } 698 // state 699 pbap_client->state = PBAP_CLIENT_W4_PHONEBOOK; 700 pbap_client->flow_next_triggered = 0; 701 pbap_client->flow_wait_for_user = 0; 702 // prepare response 703 pbap_client_prepare_get_operation(pbap_client); 704 // send packet 705 pbap_client->request_number++; 706 goep_client_execute(pbap_client->goep_cid); 707 break; 708 case PBAP_CLIENT_W2_GET_CARD_LIST: 709 // prepare request 710 goep_client_request_create_get(pbap_client->goep_cid); 711 if (pbap_client->request_number == 0){ 712 pbap_client_prepare_srm_header(pbap_client); 713 goep_client_header_add_name(pbap_client->goep_cid, pbap_client->phonebook_path); 714 goep_client_header_add_type(pbap_client->goep_cid, pbap_vcard_listing_type); 715 716 pos = 0; 717 pos += pbap_client_application_params_add_vcard_selector(pbap_client, &application_parameters[pos]); 718 pos += pbap_client_application_params_add_phone_number(pbap_client, &application_parameters[pos]); 719 pbap_client_add_application_parameters(pbap_client, application_parameters, pos); 720 } 721 // state 722 pbap_client->state = PBAP_CLIENT_W4_GET_CARD_LIST_COMPLETE; 723 // prepare response 724 pbap_client_prepare_get_operation(pbap_client); 725 // send packet 726 pbap_client->request_number++; 727 goep_client_execute(pbap_client->goep_cid); 728 break; 729 case PBAP_CLIENT_W2_GET_CARD_ENTRY: 730 // prepare request 731 goep_client_request_create_get(pbap_client->goep_cid); 732 if (pbap_client->request_number == 0){ 733 pbap_client_prepare_srm_header(pbap_client); 734 goep_client_header_add_name(pbap_client->goep_cid, pbap_client->vcard_name); 735 goep_client_header_add_type(pbap_client->goep_cid, pbap_vcard_entry_type); 736 737 pos = 0; 738 pos += pbap_client_application_params_add_property_selector(pbap_client, &application_parameters[pos]); 739 pbap_client_add_application_parameters(pbap_client, application_parameters, pos); 740 } 741 // state 742 pbap_client->state = PBAP_CLIENT_W4_GET_CARD_ENTRY_COMPLETE; 743 // prepare response 744 pbap_client_prepare_get_operation(pbap_client); 745 // send packet 746 pbap_client->request_number++; 747 goep_client_execute(pbap_client->goep_cid); 748 break; 749 case PBAP_CLIENT_W2_SET_PATH_ROOT: 750 // prepare request 751 goep_client_request_create_set_path(pbap_client->goep_cid, 1 << 1); // Don’t create directory 752 goep_client_header_add_name(pbap_client->goep_cid, ""); 753 // state 754 pbap_client->state = PBAP_CLIENT_W4_SET_PATH_ROOT_COMPLETE; 755 // prepare response 756 obex_parser_init_for_response(&pbap_client->obex_parser, OBEX_OPCODE_SETPATH, NULL, pbap_client); 757 obex_srm_init(&pbap_client->obex_srm); 758 pbap_client->obex_parser_waiting_for_response = true; 759 // send packet 760 goep_client_execute(pbap_client->goep_cid); 761 break; 762 case PBAP_CLIENT_W2_SET_PATH_ELEMENT: 763 // prepare request 764 // find '/' or '\0' 765 path_element_start = pbap_client->set_path_offset; 766 while ((pbap_client->current_folder[pbap_client->set_path_offset] != '\0') && 767 (pbap_client->current_folder[pbap_client->set_path_offset] != '/')){ 768 pbap_client->set_path_offset++; 769 } 770 path_element_len = pbap_client->set_path_offset-path_element_start; 771 path_element = (const char *) &pbap_client->current_folder[path_element_start]; 772 773 // skip / 774 if (pbap_client->current_folder[pbap_client->set_path_offset] == '/'){ 775 pbap_client->set_path_offset++; 776 } 777 778 goep_client_request_create_set_path(pbap_client->goep_cid, 1 << 1); // Don’t create directory 779 goep_client_header_add_name_prefix(pbap_client->goep_cid, path_element, path_element_len); // next element 780 // state 781 pbap_client->state = PBAP_CLIENT_W4_SET_PATH_ELEMENT_COMPLETE; 782 // prepare response 783 obex_parser_init_for_response(&pbap_client->obex_parser, OBEX_OPCODE_SETPATH, NULL, pbap_client); 784 obex_srm_init(&pbap_client->obex_srm); 785 pbap_client->obex_parser_waiting_for_response = true; 786 // send packet 787 goep_client_execute(pbap_client->goep_cid); 788 break; 789 default: 790 break; 791 } 792 } 793 794 static void pbap_client_handle_srm_headers(pbap_client_t *client) { 795 const obex_srm_t * obex_srm = &client->obex_srm; 796 // Update SRM state based on SRM headers 797 switch (client->srm_state){ 798 case SRM_W4_CONFIRM: 799 switch (obex_srm->srm_value){ 800 case OBEX_SRM_ENABLE: 801 switch (obex_srm->srmp_value){ 802 case OBEX_SRMP_WAIT: 803 client->srm_state = SRM_ENABLED_BUT_WAITING; 804 break; 805 default: 806 client->srm_state = SRM_ENABLED; 807 break; 808 } 809 break; 810 default: 811 client->srm_state = SRM_DISABLED; 812 break; 813 } 814 break; 815 case SRM_ENABLED_BUT_WAITING: 816 switch (obex_srm->srmp_value){ 817 case OBEX_SRMP_WAIT: 818 client->srm_state = SRM_ENABLED_BUT_WAITING; 819 break; 820 default: 821 client->srm_state = SRM_ENABLED; 822 break; 823 } 824 break; 825 default: 826 break; 827 } 828 log_info("SRM state %u", client->srm_state); 829 } 830 831 static void pbap_packet_handler_hci(uint8_t *packet, uint16_t size){ 832 UNUSED(size); 833 uint8_t status; 834 835 pbap_client_t * client; 836 837 switch (hci_event_packet_get_type(packet)) { 838 case HCI_EVENT_GOEP_META: 839 switch (hci_event_goep_meta_get_subevent_code(packet)){ 840 case GOEP_SUBEVENT_CONNECTION_OPENED: 841 client = pbap_client_for_cid(goep_subevent_connection_opened_get_goep_cid(packet)); 842 btstack_assert(client != NULL); 843 status = goep_subevent_connection_opened_get_status(packet); 844 goep_subevent_connection_opened_get_bd_addr(packet, client->bd_addr); 845 if (status){ 846 log_info("pbap: connection failed %u", status); 847 pbap_client_finalize(client); 848 pbap_client_emit_connected_event(client, status); 849 } else { 850 log_info("pbap: connection established"); 851 client->con_handle = goep_subevent_connection_opened_get_con_handle(packet); 852 client->state = PBAP_CLIENT_W2_SEND_CONNECT_REQUEST; 853 goep_client_request_can_send_now(client->goep_cid); 854 } 855 break; 856 case GOEP_SUBEVENT_CONNECTION_CLOSED: 857 client = pbap_client_for_cid(goep_subevent_connection_closed_get_goep_cid(packet)); 858 btstack_assert(client != NULL); 859 if (client->state > PBAP_CLIENT_CONNECTED){ 860 pbap_client_emit_operation_complete_event(client, OBEX_DISCONNECTED); 861 } 862 pbap_client_finalize(client); 863 pbap_client_emit_connection_closed_event(client); 864 break; 865 case GOEP_SUBEVENT_CAN_SEND_NOW: 866 client = pbap_client_for_cid(goep_subevent_can_send_now_get_goep_cid(packet)); 867 btstack_assert(client != NULL); 868 pbap_handle_can_send_now(client); 869 break; 870 default: 871 break; 872 } 873 break; 874 default: 875 break; 876 } 877 } 878 879 static void pbap_packet_handler_goep(pbap_client_t *client, uint8_t *packet, uint16_t size) { 880 881 if (client->obex_parser_waiting_for_response == false) return; 882 883 obex_parser_object_state_t parser_state; 884 parser_state = obex_parser_process_data(&client->obex_parser, packet, size); 885 if (parser_state == OBEX_PARSER_OBJECT_STATE_COMPLETE){ 886 client->obex_parser_waiting_for_response = false; 887 obex_parser_operation_info_t op_info; 888 obex_parser_get_operation_info(&client->obex_parser, &op_info); 889 switch (client->state){ 890 case PBAP_CLIENT_W4_CONNECT_RESPONSE: 891 switch (op_info.response_code) { 892 case OBEX_RESP_SUCCESS: 893 client->state = PBAP_CLIENT_CONNECTED; 894 client->vcard_selector_supported = pbap_client_supported_features & goep_client_get_pbap_supported_features(client->goep_cid) & PBAP_SUPPORTED_FEATURES_VCARD_SELECTING; 895 pbap_client_emit_connected_event(client, ERROR_CODE_SUCCESS); 896 break; 897 case OBEX_RESP_UNAUTHORIZED: 898 client->state = PBAP_CLIENT_W4_USER_AUTHENTICATION; 899 pbap_client_emit_authentication_event(client, client->obex_auth_parser.authentication_options); 900 break; 901 default: 902 log_info("pbap: obex connect failed, result 0x%02x", packet[0]); 903 client->state = PBAP_CLIENT_INIT; 904 pbap_client_emit_connected_event(client, OBEX_CONNECT_FAILED); 905 break; 906 } 907 break; 908 case PBAP_CLIENT_W4_DISCONNECT_RESPONSE: 909 client->state = PBAP_CLIENT_CONNECTED; 910 goep_client_disconnect(client->goep_cid); 911 break; 912 case PBAP_CLIENT_W4_SET_PATH_ROOT_COMPLETE: 913 case PBAP_CLIENT_W4_SET_PATH_ELEMENT_COMPLETE: 914 switch (op_info.response_code) { 915 case OBEX_RESP_SUCCESS: 916 // more path? 917 if (client->current_folder[client->set_path_offset]) { 918 client->state = PBAP_CLIENT_W2_SET_PATH_ELEMENT; 919 goep_client_request_can_send_now(client->goep_cid); 920 } else { 921 client->current_folder = NULL; 922 client->state = PBAP_CLIENT_CONNECTED; 923 pbap_client_emit_operation_complete_event(client, ERROR_CODE_SUCCESS); 924 } 925 break; 926 case OBEX_RESP_NOT_FOUND: 927 client->state = PBAP_CLIENT_CONNECTED; 928 pbap_client_emit_operation_complete_event(client, OBEX_NOT_FOUND); 929 break; 930 default: 931 client->state = PBAP_CLIENT_CONNECTED; 932 pbap_client_emit_operation_complete_event(client, OBEX_UNKNOWN_ERROR); 933 break; 934 } 935 break; 936 case PBAP_CLIENT_W4_PHONEBOOK: 937 switch (op_info.response_code) { 938 case OBEX_RESP_CONTINUE: 939 pbap_client_handle_srm_headers(client); 940 if (client->srm_state == SRM_ENABLED) { 941 // prepare response 942 pbap_client_prepare_get_operation(client); 943 break; 944 } 945 client->state = PBAP_CLIENT_W2_PULL_PHONEBOOK; 946 if (!client->flow_control_enabled || !client->flow_wait_for_user || 947 client->flow_next_triggered) { 948 goep_client_request_can_send_now(client->goep_cid); 949 } 950 break; 951 case OBEX_RESP_SUCCESS: 952 client->state = PBAP_CLIENT_CONNECTED; 953 pbap_client_emit_operation_complete_event(client, ERROR_CODE_SUCCESS); 954 break; 955 default: 956 log_info("unexpected response 0x%02x", packet[0]); 957 client->state = PBAP_CLIENT_CONNECTED; 958 pbap_client_emit_operation_complete_event(client, OBEX_UNKNOWN_ERROR); 959 break; 960 } 961 break; 962 case PBAP_CLIENT_W4_GET_PHONEBOOK_SIZE_COMPLETE: 963 switch (op_info.response_code) { 964 case OBEX_RESP_SUCCESS: 965 if (client->phonebook_size_parser.have_size) { 966 uint16_t phonebook_size = big_endian_read_16(client->phonebook_size_parser.size_buffer, 0); 967 client->state = PBAP_CLIENT_CONNECTED; 968 pbap_client_emit_phonebook_size_event(client, 0, phonebook_size); 969 break; 970 } 971 /* fall through */ 972 default: 973 client->state = PBAP_CLIENT_CONNECTED; 974 pbap_client_emit_phonebook_size_event(client, OBEX_UNKNOWN_ERROR, 0); 975 break; 976 } 977 break; 978 case PBAP_CLIENT_W4_GET_CARD_LIST_COMPLETE: 979 switch (op_info.response_code) { 980 case OBEX_RESP_CONTINUE: 981 // handle continue 982 pbap_client_handle_srm_headers(client); 983 if (client->srm_state == SRM_ENABLED) { 984 // prepare response 985 pbap_client_prepare_get_operation(client); 986 break; 987 } 988 client->state = PBAP_CLIENT_W2_GET_CARD_LIST; 989 goep_client_request_can_send_now(client->goep_cid); 990 break; 991 case OBEX_RESP_SUCCESS: 992 // done 993 client->state = PBAP_CLIENT_CONNECTED; 994 pbap_client_emit_operation_complete_event(client, ERROR_CODE_SUCCESS); 995 break; 996 case OBEX_RESP_NOT_ACCEPTABLE: 997 client->state = PBAP_CLIENT_CONNECTED; 998 pbap_client_emit_operation_complete_event(client, OBEX_NOT_ACCEPTABLE); 999 break; 1000 default: 1001 log_info("unexpected response 0x%02x", packet[0]); 1002 client->state = PBAP_CLIENT_CONNECTED; 1003 pbap_client_emit_operation_complete_event(client, OBEX_UNKNOWN_ERROR); 1004 break; 1005 } 1006 break; 1007 case PBAP_CLIENT_W4_GET_CARD_ENTRY_COMPLETE: 1008 switch (op_info.response_code) { 1009 case OBEX_RESP_CONTINUE: 1010 pbap_client_handle_srm_headers(client); 1011 if (client->srm_state == SRM_ENABLED) { 1012 // prepare response 1013 pbap_client_prepare_get_operation(client); 1014 break; 1015 } 1016 client->state = PBAP_CLIENT_W2_GET_CARD_ENTRY; 1017 goep_client_request_can_send_now(client->goep_cid); 1018 break; 1019 case OBEX_RESP_SUCCESS: 1020 client->state = PBAP_CLIENT_CONNECTED; 1021 pbap_client_emit_operation_complete_event(client, ERROR_CODE_SUCCESS); 1022 break; 1023 case OBEX_RESP_NOT_ACCEPTABLE: 1024 client->state = PBAP_CLIENT_CONNECTED; 1025 pbap_client_emit_operation_complete_event(client, OBEX_NOT_ACCEPTABLE); 1026 break; 1027 default: 1028 log_info("unexpected response 0x%02x", packet[0]); 1029 client->state = PBAP_CLIENT_CONNECTED; 1030 pbap_client_emit_operation_complete_event(client, OBEX_UNKNOWN_ERROR); 1031 break; 1032 } 1033 break; 1034 case PBAP_CLIENT_W4_ABORT_COMPLETE: 1035 client->state = PBAP_CLIENT_CONNECTED; 1036 pbap_client_emit_operation_complete_event(client, OBEX_ABORTED); 1037 break; 1038 default: 1039 btstack_unreachable(); 1040 break; 1041 } 1042 } 1043 } 1044 1045 static void pbap_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ 1046 UNUSED(channel); // ok: there is no channel 1047 UNUSED(size); // ok: handling own geop events 1048 1049 pbap_client_t * client; 1050 1051 switch (packet_type){ 1052 case HCI_EVENT_PACKET: 1053 pbap_packet_handler_hci(packet, size); 1054 break; 1055 case GOEP_DATA_PACKET: 1056 client = pbap_client_for_cid(channel); 1057 btstack_assert(client != NULL); 1058 pbap_packet_handler_goep(client, packet, size); 1059 break; 1060 default: 1061 break; 1062 } 1063 } 1064 1065 void pbap_client_init(void){ 1066 pbap_client_supported_features = 1067 PBAP_SUPPORTED_FEATURES_DOWNLOAD | 1068 PBAP_SUPPORTED_FEATURES_BROWSING | 1069 PBAP_SUPPORTED_FEATURES_DATABASE_IDENTIFIER | 1070 PBAP_SUPPORTED_FEATURES_FOLDER_VERSION_COUNTERS | 1071 PBAP_SUPPORTED_FEATURES_VCARD_SELECTING | 1072 PBAP_SUPPORTED_FEATURES_ENHANCED_MISSED_CALLS | 1073 PBAP_SUPPORTED_FEATURES_DEFAULT_CONTACT_IMAGE_FORMAT | 1074 PBAP_SUPPORTED_FEATURES_X_BT_UCI_VCARD_PROPERTY | 1075 PBAP_SUPPORTED_FEATURES_X_BT_UID_VCARD_PROPERTY | 1076 PBAP_SUPPORTED_FEATURES_CONTACT_REFERENCING; 1077 1078 pbap_client_singleton_used = false; 1079 } 1080 1081 void pbap_client_deinit(void){ 1082 } 1083 1084 uint8_t pbap_client_connect(pbap_client_t * client, btstack_packet_handler_t handler, bd_addr_t addr, uint16_t * out_cid) { 1085 client->state = PBAP_CLIENT_W4_GOEP_CONNECTION; 1086 client->client_handler = handler; 1087 client->vcard_selector = 0; 1088 client->vcard_selector_operator = PBAP_VCARD_SELECTOR_OPERATOR_OR; 1089 1090 btstack_linked_list_add(&pbap_clients, (btstack_linked_item_t*) client); 1091 1092 uint8_t status = goep_client_create_connection(&pbap_packet_handler, addr, BLUETOOTH_SERVICE_CLASS_PHONEBOOK_ACCESS_PSE, &client->goep_cid); 1093 *out_cid = client->goep_cid; 1094 1095 if (status) { 1096 pbap_client_finalize(client); 1097 } 1098 return status; 1099 } 1100 1101 uint8_t pbap_connect(btstack_packet_handler_t handler, bd_addr_t addr, uint16_t * out_cid){ 1102 static pbap_client_t pbap_client_singleton; 1103 1104 if (pbap_client_singleton_used && pbap_client_singleton.state != PBAP_CLIENT_INIT){ 1105 return BTSTACK_MEMORY_ALLOC_FAILED; 1106 } 1107 1108 pbap_client_singleton_used = true; 1109 1110 memset(&pbap_client_singleton, 0, sizeof(pbap_client_t)); 1111 return pbap_client_connect(&pbap_client_singleton, handler, addr, out_cid); 1112 } 1113 1114 uint8_t pbap_disconnect(uint16_t pbap_cid){ 1115 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1116 if (pbap_client == NULL){ 1117 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1118 } 1119 if (pbap_client->state < PBAP_CLIENT_CONNECTED){ 1120 return BTSTACK_BUSY; 1121 } 1122 pbap_client->state = PBAP_CLIENT_W2_SEND_DISCONNECT_REQUEST; 1123 goep_client_request_can_send_now(pbap_client->goep_cid); 1124 return ERROR_CODE_SUCCESS; 1125 } 1126 1127 uint8_t pbap_get_phonebook_size(uint16_t pbap_cid, const char * path){ 1128 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1129 if (pbap_client == NULL){ 1130 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1131 } 1132 if (pbap_client->state != PBAP_CLIENT_CONNECTED){ 1133 return BTSTACK_BUSY; 1134 } 1135 pbap_client->state = PBAP_CLIENT_W2_GET_PHONEBOOK_SIZE; 1136 pbap_client->phonebook_path = path; 1137 pbap_client->request_number = 0; 1138 goep_client_request_can_send_now(pbap_client->goep_cid); 1139 return ERROR_CODE_SUCCESS; 1140 } 1141 1142 uint8_t pbap_pull_phonebook(uint16_t pbap_cid, const char * path){ 1143 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1144 if (pbap_client == NULL){ 1145 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1146 } 1147 if (pbap_client->state != PBAP_CLIENT_CONNECTED){ 1148 return BTSTACK_BUSY; 1149 } 1150 pbap_client->state = PBAP_CLIENT_W2_PULL_PHONEBOOK; 1151 pbap_client->phonebook_path = path; 1152 pbap_client->vcard_name = NULL; 1153 pbap_client->request_number = 0; 1154 goep_client_request_can_send_now(pbap_client->goep_cid); 1155 return ERROR_CODE_SUCCESS; 1156 } 1157 1158 uint8_t pbap_set_phonebook(uint16_t pbap_cid, const char * path){ 1159 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1160 if (pbap_client == NULL){ 1161 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1162 } 1163 if (pbap_client->state != PBAP_CLIENT_CONNECTED){ 1164 return BTSTACK_BUSY; 1165 } 1166 pbap_client->state = PBAP_CLIENT_W2_SET_PATH_ROOT; 1167 pbap_client->current_folder = path; 1168 pbap_client->set_path_offset = 0; 1169 goep_client_request_can_send_now(pbap_client->goep_cid); 1170 return ERROR_CODE_SUCCESS; 1171 } 1172 1173 uint8_t pbap_authentication_password(uint16_t pbap_cid, const char * password){ 1174 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1175 if (pbap_client == NULL){ 1176 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1177 } 1178 if (pbap_client->state != PBAP_CLIENT_W4_USER_AUTHENTICATION){ 1179 return BTSTACK_BUSY; 1180 } 1181 pbap_client->state = PBAP_CLIENT_W2_SEND_AUTHENTICATED_CONNECT; 1182 pbap_client->authentication_password = password; 1183 goep_client_request_can_send_now(pbap_client->goep_cid); 1184 return ERROR_CODE_SUCCESS; 1185 } 1186 1187 uint8_t pbap_pull_vcard_listing(uint16_t pbap_cid, const char * path){ 1188 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1189 if (pbap_client == NULL){ 1190 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1191 } 1192 if (pbap_client->state != PBAP_CLIENT_CONNECTED){ 1193 return BTSTACK_BUSY; 1194 } 1195 pbap_client->state = PBAP_CLIENT_W2_GET_CARD_LIST; 1196 pbap_client->phonebook_path = path; 1197 pbap_client->phone_number = NULL; 1198 pbap_client->request_number = 0; 1199 pbap_client_vcard_listing_init_parser(pbap_client); 1200 goep_client_request_can_send_now(pbap_client->goep_cid); 1201 return ERROR_CODE_SUCCESS; 1202 } 1203 1204 uint8_t pbap_pull_vcard_entry(uint16_t pbap_cid, const char * path){ 1205 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1206 if (pbap_client == NULL){ 1207 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1208 } 1209 if (pbap_client->state != PBAP_CLIENT_CONNECTED){ 1210 return BTSTACK_BUSY; 1211 } 1212 pbap_client->state = PBAP_CLIENT_W2_GET_CARD_ENTRY; 1213 // pbap_client->phonebook_path = NULL; 1214 // pbap_client->phone_number = NULL; 1215 pbap_client->vcard_name = path; 1216 pbap_client->request_number = 0; 1217 goep_client_request_can_send_now(pbap_client->goep_cid); 1218 return ERROR_CODE_SUCCESS; 1219 } 1220 1221 uint8_t pbap_lookup_by_number(uint16_t pbap_cid, const char * phone_number){ 1222 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1223 if (pbap_client == NULL){ 1224 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1225 } 1226 if (pbap_client->state != PBAP_CLIENT_CONNECTED){ 1227 return BTSTACK_BUSY; 1228 } 1229 pbap_client->state = PBAP_CLIENT_W2_GET_CARD_LIST; 1230 pbap_client->phonebook_path = pbap_vcard_listing_name; 1231 pbap_client->phone_number = phone_number; 1232 pbap_client->request_number = 0; 1233 pbap_client_vcard_listing_init_parser(pbap_client); 1234 goep_client_request_can_send_now(pbap_client->goep_cid); 1235 return ERROR_CODE_SUCCESS; 1236 } 1237 1238 uint8_t pbap_abort(uint16_t pbap_cid){ 1239 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1240 if (pbap_client == NULL){ 1241 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1242 } 1243 if ((pbap_client->state < PBAP_CLIENT_CONNECTED) || (pbap_client->abort_operation != 0)){ 1244 return ERROR_CODE_COMMAND_DISALLOWED; 1245 } 1246 log_info("abort current operation, state 0x%02x", pbap_client->state); 1247 pbap_client->abort_operation = 1; 1248 return ERROR_CODE_SUCCESS; 1249 } 1250 1251 uint8_t pbap_next_packet(uint16_t pbap_cid){ 1252 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1253 if (pbap_client == NULL){ 1254 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1255 } 1256 if (!pbap_client->flow_control_enabled){ 1257 return ERROR_CODE_SUCCESS; 1258 } 1259 switch (pbap_client->state){ 1260 case PBAP_CLIENT_W2_PULL_PHONEBOOK: 1261 goep_client_request_can_send_now(pbap_client->goep_cid); 1262 break; 1263 case PBAP_CLIENT_W4_PHONEBOOK: 1264 pbap_client->flow_next_triggered = 1; 1265 break; 1266 default: 1267 break; 1268 } 1269 return ERROR_CODE_SUCCESS; 1270 } 1271 1272 uint8_t pbap_set_flow_control_mode(uint16_t pbap_cid, int enable){ 1273 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1274 if (pbap_client == NULL){ 1275 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1276 } 1277 if (pbap_client->state != PBAP_CLIENT_CONNECTED){ 1278 return BTSTACK_BUSY; 1279 } 1280 pbap_client->flow_control_enabled = enable; 1281 return ERROR_CODE_SUCCESS; 1282 } 1283 1284 uint8_t pbap_set_vcard_selector(uint16_t pbap_cid, uint32_t vcard_selector){ 1285 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1286 if (pbap_client == NULL){ 1287 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1288 } 1289 if (pbap_client->state != PBAP_CLIENT_CONNECTED){ 1290 return BTSTACK_BUSY; 1291 } 1292 pbap_client->vcard_selector = vcard_selector; 1293 return ERROR_CODE_SUCCESS; 1294 } 1295 1296 uint8_t pbap_set_vcard_selector_operator(uint16_t pbap_cid, int vcard_selector_operator){ 1297 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1298 if (pbap_client == NULL){ 1299 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1300 } 1301 if (pbap_client->state != PBAP_CLIENT_CONNECTED){ 1302 return BTSTACK_BUSY; 1303 } 1304 pbap_client->vcard_selector_operator = vcard_selector_operator; 1305 return ERROR_CODE_SUCCESS; 1306 } 1307 1308 uint8_t pbap_set_property_selector(uint16_t pbap_cid, uint32_t property_selector){ 1309 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1310 if (pbap_client == NULL){ 1311 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1312 } 1313 if (pbap_client->state != PBAP_CLIENT_CONNECTED){ 1314 return BTSTACK_BUSY; 1315 } 1316 pbap_client->property_selector = property_selector; 1317 return ERROR_CODE_SUCCESS; 1318 } 1319 1320 uint8_t pbap_set_max_list_count(uint16_t pbap_cid, uint16_t max_list_count){ 1321 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1322 if (pbap_client == NULL){ 1323 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1324 } 1325 if (pbap_client->state != PBAP_CLIENT_CONNECTED){ 1326 return BTSTACK_BUSY; 1327 } 1328 pbap_client->max_list_count = max_list_count; 1329 return ERROR_CODE_SUCCESS; 1330 } 1331 1332 uint8_t pbap_set_list_start_offset(uint16_t pbap_cid, uint16_t list_start_offset){ 1333 pbap_client_t * pbap_client = pbap_client_for_cid(pbap_cid); 1334 if (pbap_client == NULL){ 1335 return ERROR_CODE_UNKNOWN_CONNECTION_IDENTIFIER; 1336 } 1337 if (pbap_client->state != PBAP_CLIENT_CONNECTED){ 1338 return BTSTACK_BUSY; 1339 } 1340 pbap_client->list_start_offset = list_start_offset; 1341 return ERROR_CODE_SUCCESS; 1342 } 1343