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