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