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 MATTHIAS 24 * RINGWALD 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__ "hfp_ag_demo.c" 39 40 /* 41 * hfp_ag_demo.c 42 */ 43 44 // ***************************************************************************** 45 /* EXAMPLE_START(hfp_ag_demo): HFP Audio Gateway (AG) Demo 46 * 47 * @text This HFP Audio Gateway example demonstrates how to receive 48 * an output from a remote HFP Hands-Free (HF) unit, and, 49 * if HAVE_BTSTACK_STDIN is defined, how to control the HFP HF. 50 */ 51 // ***************************************************************************** 52 53 54 #include <stdint.h> 55 #include <stdio.h> 56 #include <stdlib.h> 57 #include <string.h> 58 59 #include "btstack.h" 60 #include "sco_demo_util.h" 61 #ifdef HAVE_BTSTACK_STDIN 62 #include "btstack_stdin.h" 63 #endif 64 65 // uncomment to temp disable mSBC codec 66 // #undef ENABLE_HFP_WIDE_BAND_SPEECH 67 68 uint8_t hfp_service_buffer[150]; 69 const uint8_t rfcomm_channel_nr = 1; 70 const char hfp_ag_service_name[] = "HFP AG Demo"; 71 72 static bd_addr_t device_addr; 73 static const char * device_addr_string = "00:21:3C:AC:F7:38"; 74 75 #ifdef ENABLE_HFP_WIDE_BAND_SPEECH 76 static uint8_t codecs[] = {HFP_CODEC_CVSD, HFP_CODEC_MSBC}; 77 #else 78 static uint8_t codecs[] = {HFP_CODEC_CVSD}; 79 #endif 80 81 static uint8_t negotiated_codec = HFP_CODEC_CVSD; 82 83 static hci_con_handle_t acl_handle = HCI_CON_HANDLE_INVALID; 84 static hci_con_handle_t sco_handle = HCI_CON_HANDLE_INVALID; 85 static int memory_1_enabled = 1; 86 static btstack_packet_callback_registration_t hci_event_callback_registration; 87 88 static int ag_indicators_nr = 7; 89 static hfp_ag_indicator_t ag_indicators[] = { 90 // index, name, min range, max range, status, mandatory, enabled, status changed 91 {1, "service", 0, 1, 1, 0, 0, 0}, 92 {2, "call", 0, 1, 0, 1, 1, 0}, 93 {3, "callsetup", 0, 3, 0, 1, 1, 0}, 94 {4, "battchg", 0, 5, 3, 0, 0, 0}, 95 {5, "signal", 0, 5, 5, 0, 1, 0}, 96 {6, "roam", 0, 1, 0, 0, 1, 0}, 97 {7, "callheld", 0, 2, 0, 1, 1, 0} 98 }; 99 100 static int call_hold_services_nr = 5; 101 static const char* call_hold_services[] = {"1", "1x", "2", "2x", "3"}; 102 103 static int hf_indicators_nr = 2; 104 static hfp_generic_status_indicator_t hf_indicators[] = { 105 {1, 1}, 106 {2, 1}, 107 }; 108 109 #define INQUIRY_INTERVAL 5 110 111 enum STATE {INIT, W4_INQUIRY_MODE_COMPLETE, ACTIVE} ; 112 enum STATE state = INIT; 113 114 static void dump_supported_codecs(void){ 115 unsigned int i; 116 int mSBC_skipped = 0; 117 printf("Supported codecs: "); 118 for (i = 0; i < sizeof(codecs); i++){ 119 switch(codecs[i]){ 120 case HFP_CODEC_CVSD: 121 printf("CVSD"); 122 break; 123 case HFP_CODEC_MSBC: 124 if (hci_extended_sco_link_supported()){ 125 printf(", mSBC"); 126 } else { 127 mSBC_skipped = 1; 128 } 129 break; 130 } 131 } 132 printf("\n"); 133 if (mSBC_skipped){ 134 printf("mSBC codec disabled because eSCO not supported by local controller.\n"); 135 } 136 } 137 138 #ifdef HAVE_BTSTACK_STDIN 139 // Testig User Interface 140 static void show_usage(void){ 141 bd_addr_t iut_address; 142 gap_local_bd_addr(iut_address); 143 144 printf("\n--- Bluetooth HFP Audiogateway (AG) unit Test Console %s ---\n", bd_addr_to_str(iut_address)); 145 printf("\n"); 146 147 printf("a - establish HFP connection to %s\n", bd_addr_to_str(device_addr)); 148 // printf("A - release HFP connection\n"); 149 150 printf("b - establish AUDIO connection | B - release AUDIO connection\n"); 151 printf("c - simulate incoming call from 1234567 | C - simulate call from 1234567 dropped\n"); 152 printf("d - report AG failure\n"); 153 printf("e - answer call on AG | E - reject call on AG\n"); 154 printf("r - disable in-band ring tone | R - enable in-band ring tone\n"); 155 printf("f - Disable cellular network | F - Enable cellular network\n"); 156 printf("g - Set signal strength to 0 | G - Set signal strength to 5\n"); 157 printf("h - Disable roaming | H - Enable roaming\n"); 158 printf("i - Set battery level to 3 | I - Set battery level to 5\n"); 159 printf("j - Answering call on remote side\n"); 160 printf("k - Clear memory #1 | K - Set memory #1\n"); 161 printf("l - Clear last number | L - Set last number\n"); 162 printf("m - simulate incoming call from 7654321\n"); 163 // printf("M - simulate call from 7654321 dropped\n"); 164 printf("n - Disable Voice Regocnition | N - Enable Voice Recognition\n"); 165 printf("o - Set speaker volume to 0 (minimum) | O - Set speaker volume to 9 (default)\n"); 166 printf("p - Set speaker volume to 12 (higher) | P - Set speaker volume to 15 (maximum)\n"); 167 printf("q - Set microphone gain to 0 (minimum) | Q - Set microphone gain to 9 (default)\n"); 168 printf("s - Set microphone gain to 12 (higher) | S - Set microphone gain to 15 (maximum)\n"); 169 printf("t - terminate connection\n"); 170 printf("u - join held call\n"); 171 printf("v - discover nearby HF units\n"); 172 printf("w - put incoming call on hold (Response and Hold)\n"); 173 printf("x - accept held incoming call (Response and Hold)\n"); 174 printf("X - reject held incoming call (Response and Hold)\n"); 175 printf("---\n"); 176 } 177 178 static void stdin_process(char cmd){ 179 switch (cmd){ 180 case 'a': 181 log_info("USER:\'%c\'", cmd); 182 printf("Establish HFP service level connection to %s...\n", bd_addr_to_str(device_addr)); 183 hfp_ag_establish_service_level_connection(device_addr); 184 break; 185 case 'A': 186 log_info("USER:\'%c\'", cmd); 187 printf("Release HFP service level connection.\n"); 188 hfp_ag_release_service_level_connection(acl_handle); 189 break; 190 case 'Z': 191 log_info("USER:\'%c\'", cmd); 192 printf("Release HFP service level connection to %s...\n", bd_addr_to_str(device_addr)); 193 hfp_ag_release_service_level_connection(acl_handle); 194 break; 195 case 'b': 196 log_info("USER:\'%c\'", cmd); 197 printf("Establish Audio connection %s...\n", bd_addr_to_str(device_addr)); 198 hfp_ag_establish_audio_connection(acl_handle); 199 break; 200 case 'B': 201 log_info("USER:\'%c\'", cmd); 202 printf("Release Audio connection.\n"); 203 hfp_ag_release_audio_connection(acl_handle); 204 break; 205 case 'c': 206 log_info("USER:\'%c\'", cmd); 207 printf("Simulate incoming call from 1234567\n"); 208 hfp_ag_set_clip(129, "1234567"); 209 hfp_ag_incoming_call(); 210 break; 211 case 'm': 212 log_info("USER:\'%c\'", cmd); 213 printf("Simulate incoming call from 7654321\n"); 214 hfp_ag_set_clip(129, "7654321"); 215 hfp_ag_incoming_call(); 216 break; 217 case 'C': 218 log_info("USER:\'%c\'", cmd); 219 printf("Simulate terminate call\n"); 220 hfp_ag_call_dropped(); 221 break; 222 case 'd': 223 log_info("USER:\'%c\'", cmd); 224 printf("Report AG failure\n"); 225 hfp_ag_report_extended_audio_gateway_error_result_code(acl_handle, HFP_CME_ERROR_AG_FAILURE); 226 break; 227 case 'e': 228 log_info("USER:\'%c\'", cmd); 229 printf("Answer call on AG\n"); 230 hfp_ag_answer_incoming_call(); 231 break; 232 case 'E': 233 log_info("USER:\'%c\'", cmd); 234 printf("Reject call on AG\n"); 235 hfp_ag_terminate_call(); 236 break; 237 case 'f': 238 log_info("USER:\'%c\'", cmd); 239 printf("Disable cellular network\n"); 240 hfp_ag_set_registration_status(0); 241 break; 242 case 'F': 243 log_info("USER:\'%c\'", cmd); 244 printf("Enable cellular network\n"); 245 hfp_ag_set_registration_status(1); 246 break; 247 case 'g': 248 log_info("USER:\'%c\'", cmd); 249 printf("Set signal strength to 0\n"); 250 hfp_ag_set_signal_strength(0); 251 break; 252 case 'G': 253 log_info("USER:\'%c\'", cmd); 254 printf("Set signal strength to 5\n"); 255 hfp_ag_set_signal_strength(5); 256 break; 257 case 'h': 258 log_info("USER:\'%c\'", cmd); 259 printf("Disable roaming\n"); 260 hfp_ag_set_roaming_status(0); 261 break; 262 case 'H': 263 log_info("USER:\'%c\'", cmd); 264 printf("Enable roaming\n"); 265 hfp_ag_set_roaming_status(1); 266 break; 267 case 'i': 268 log_info("USER:\'%c\'", cmd); 269 printf("Set battery level to 3\n"); 270 hfp_ag_set_battery_level(3); 271 break; 272 case 'I': 273 log_info("USER:\'%c\'", cmd); 274 printf("Set battery level to 5\n"); 275 hfp_ag_set_battery_level(5); 276 break; 277 case 'j': 278 log_info("USER:\'%c\'", cmd); 279 printf("Answering call on remote side\n"); 280 hfp_ag_outgoing_call_established(); 281 break; 282 case 'r': 283 log_info("USER:\'%c\'", cmd); 284 printf("Disable in-band ring tone\n"); 285 hfp_ag_set_use_in_band_ring_tone(0); 286 break; 287 case 'k': 288 log_info("USER:\'%c\'", cmd); 289 printf("Memory 1 cleared\n"); 290 memory_1_enabled = 0; 291 break; 292 case 'K': 293 log_info("USER:\'%c\'", cmd); 294 printf("Memory 1 set\n"); 295 memory_1_enabled = 1; 296 break; 297 case 'l': 298 log_info("USER:\'%c\'", cmd); 299 printf("Last dialed number cleared\n"); 300 hfp_ag_clear_last_dialed_number(); 301 break; 302 case 'L': 303 log_info("USER:\'%c\'", cmd); 304 printf("Outgoing call connected, ringing\n"); 305 hfp_ag_outgoing_call_ringing(); 306 break; 307 case 'n': 308 log_info("USER:\'%c\'", cmd); 309 printf("Disable Voice Recognition\n"); 310 hfp_ag_activate_voice_recognition(acl_handle, 0); 311 break; 312 case 'N': 313 log_info("USER:\'%c\'", cmd); 314 printf("Enable Voice Recognition\n"); 315 hfp_ag_activate_voice_recognition(acl_handle, 1); 316 break; 317 case 'o': 318 log_info("USER:\'%c\'", cmd); 319 printf("Set speaker gain to 0 (minimum)\n"); 320 hfp_ag_set_speaker_gain(acl_handle, 0); 321 break; 322 case 'O': 323 log_info("USER:\'%c\'", cmd); 324 printf("Set speaker gain to 9 (default)\n"); 325 hfp_ag_set_speaker_gain(acl_handle, 9); 326 break; 327 case 'p': 328 log_info("USER:\'%c\'", cmd); 329 printf("Set speaker gain to 12 (higher)\n"); 330 hfp_ag_set_speaker_gain(acl_handle, 12); 331 break; 332 case 'P': 333 log_info("USER:\'%c\'", cmd); 334 printf("Set speaker gain to 15 (maximum)\n"); 335 hfp_ag_set_speaker_gain(acl_handle, 15); 336 break; 337 case 'q': 338 log_info("USER:\'%c\'", cmd); 339 printf("Set microphone gain to 0\n"); 340 hfp_ag_set_microphone_gain(acl_handle, 0); 341 break; 342 case 'Q': 343 log_info("USER:\'%c\'", cmd); 344 printf("Set microphone gain to 9\n"); 345 hfp_ag_set_microphone_gain(acl_handle, 9); 346 break; 347 case 's': 348 log_info("USER:\'%c\'", cmd); 349 printf("Set microphone gain to 12\n"); 350 hfp_ag_set_microphone_gain(acl_handle, 12); 351 break; 352 case 'S': 353 log_info("USER:\'%c\'", cmd); 354 printf("Set microphone gain to 15\n"); 355 hfp_ag_set_microphone_gain(acl_handle, 15); 356 break; 357 case 'R': 358 log_info("USER:\'%c\'", cmd); 359 printf("Enable in-band ring tone\n"); 360 hfp_ag_set_use_in_band_ring_tone(1); 361 break; 362 case 't': 363 log_info("USER:\'%c\'", cmd); 364 printf("Terminate HCI connection. 0x%2x\n", acl_handle); 365 gap_disconnect(acl_handle); 366 break; 367 case 'u': 368 log_info("USER:\'%c\'", cmd); 369 printf("Join held call\n"); 370 hfp_ag_join_held_call(); 371 break; 372 case 'v': 373 printf("Start scanning...\n"); 374 gap_inquiry_start(INQUIRY_INTERVAL); 375 break; 376 case 'w': 377 log_info("USER:\'%c\'", cmd); 378 printf("AG: Put incoming call on hold (Response and Hold)\n"); 379 hfp_ag_hold_incoming_call(); 380 break; 381 case 'x': 382 log_info("USER:\'%c\'", cmd); 383 printf("AG: Accept held incoming call (Response and Hold)\n"); 384 hfp_ag_accept_held_incoming_call(); 385 break; 386 case 'X': 387 log_info("USER:\'%c\'", cmd); 388 printf("AG: Reject held incoming call (Response and Hold)\n"); 389 hfp_ag_reject_held_incoming_call(); 390 break; 391 default: 392 show_usage(); 393 break; 394 } 395 } 396 #endif 397 398 static void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t * event, uint16_t event_size){ 399 UNUSED(channel); 400 bd_addr_t addr; 401 uint8_t status; 402 switch (packet_type){ 403 case HCI_EVENT_PACKET: 404 switch(hci_event_packet_get_type(event)){ 405 #ifndef HAVE_BTSTACK_STDIN 406 case BTSTACK_EVENT_STATE: 407 if (btstack_event_state_get_state(event) != HCI_STATE_WORKING) break; 408 printf("Establish HFP AG service level connection to %s...\n", bd_addr_to_str(device_addr)); 409 hfp_ag_establish_service_level_connection(device_addr); 410 break; 411 #endif 412 case GAP_EVENT_INQUIRY_RESULT: 413 gap_event_inquiry_result_get_bd_addr(event, addr); 414 // print info 415 printf("Device found: %s ", bd_addr_to_str(addr)); 416 printf("with COD: 0x%06x, ", (unsigned int) gap_event_inquiry_result_get_class_of_device(event)); 417 if (gap_event_inquiry_result_get_rssi_available(event)){ 418 printf(", rssi %d dBm", (int8_t) gap_event_inquiry_result_get_rssi(event)); 419 } 420 if (gap_event_inquiry_result_get_name_available(event)){ 421 char name_buffer[240]; 422 int name_len = gap_event_inquiry_result_get_name_len(event); 423 memcpy(name_buffer, gap_event_inquiry_result_get_name(event), name_len); 424 name_buffer[name_len] = 0; 425 printf(", name '%s'", name_buffer); 426 } 427 printf("\n"); 428 break; 429 case GAP_EVENT_INQUIRY_COMPLETE: 430 printf("Inquiry scan complete.\n"); 431 break; 432 case HCI_EVENT_SCO_CAN_SEND_NOW: 433 sco_demo_send(sco_handle); 434 break; 435 case HCI_EVENT_COMMAND_COMPLETE: 436 if (HCI_EVENT_IS_COMMAND_COMPLETE(event, hci_read_local_supported_features)){ 437 dump_supported_codecs(); 438 } 439 break; 440 default: 441 break; 442 } 443 444 if (hci_event_packet_get_type(event) != HCI_EVENT_HFP_META) return; 445 446 if (event[3] 447 && hci_event_hfp_meta_get_subevent_code(event) != HFP_SUBEVENT_PLACE_CALL_WITH_NUMBER 448 && hci_event_hfp_meta_get_subevent_code(event) != HFP_SUBEVENT_ATTACH_NUMBER_TO_VOICE_TAG 449 && hci_event_hfp_meta_get_subevent_code(event) != HFP_SUBEVENT_TRANSMIT_DTMF_CODES){ 450 printf("ERROR, status: %u\n", event[3]); 451 return; 452 } 453 454 switch (hci_event_hfp_meta_get_subevent_code(event)) { 455 case HFP_SUBEVENT_SERVICE_LEVEL_CONNECTION_ESTABLISHED: 456 status = hfp_subevent_service_level_connection_established_get_status(event); 457 if (status){ 458 printf("Connection failed, staus 0x%02x\n", status); 459 break; 460 } 461 acl_handle = hfp_subevent_service_level_connection_established_get_con_handle(event); 462 hfp_subevent_service_level_connection_established_get_bd_addr(event, device_addr); 463 printf("Service level connection established to %s.\n", bd_addr_to_str(device_addr)); 464 dump_supported_codecs(); 465 #ifndef HAVE_BTSTACK_STDIN 466 log_info("Establish Audio connection %s", bd_addr_to_str(device_addr)); 467 printf("Establish Audio connection %s...\n", bd_addr_to_str(device_addr)); 468 hfp_ag_establish_audio_connection(acl_handle); 469 #endif 470 break; 471 case HFP_SUBEVENT_SERVICE_LEVEL_CONNECTION_RELEASED: 472 printf("Service level connection released.\n"); 473 acl_handle = HCI_CON_HANDLE_INVALID; 474 break; 475 case HFP_SUBEVENT_AUDIO_CONNECTION_ESTABLISHED: 476 if (hfp_subevent_audio_connection_established_get_status(event)){ 477 printf("Audio connection establishment failed with status %u\n", hfp_subevent_audio_connection_established_get_status(event)); 478 } else { 479 sco_handle = hfp_subevent_audio_connection_established_get_handle(event); 480 printf("Audio connection established with SCO handle 0x%04x.\n", sco_handle); 481 negotiated_codec = hfp_subevent_audio_connection_established_get_negotiated_codec(event); 482 switch (negotiated_codec){ 483 case 0x01: 484 printf("Using CVSD codec.\n"); 485 break; 486 case 0x02: 487 printf("Using mSBC codec.\n"); 488 break; 489 default: 490 printf("Using unknown codec 0x%02x.\n", negotiated_codec); 491 break; 492 } 493 sco_demo_set_codec(negotiated_codec); 494 hci_request_sco_can_send_now_event(); 495 } 496 break; 497 case HFP_SUBEVENT_AUDIO_CONNECTION_RELEASED: 498 printf("Audio connection released\n"); 499 sco_handle = HCI_CON_HANDLE_INVALID; 500 sco_demo_close(); 501 break; 502 case HFP_SUBEVENT_START_RINGINIG: 503 printf("Start Ringing\n"); 504 break; 505 case HFP_SUBEVENT_STOP_RINGINIG: 506 printf("Stop Ringing\n"); 507 break; 508 case HFP_SUBEVENT_PLACE_CALL_WITH_NUMBER: 509 printf("Outgoing call '%s'\n", hfp_subevent_place_call_with_number_get_number(event)); 510 // validate number 511 if ( strcmp("1234567", hfp_subevent_place_call_with_number_get_number(event)) == 0 512 || strcmp("7654321", hfp_subevent_place_call_with_number_get_number(event)) == 0 513 || (memory_1_enabled && strcmp(">1", hfp_subevent_place_call_with_number_get_number(event)) == 0)){ 514 printf("Dialstring valid: accept call\n"); 515 hfp_ag_outgoing_call_accepted(); 516 } else { 517 printf("Dialstring invalid: reject call\n"); 518 hfp_ag_outgoing_call_rejected(); 519 } 520 break; 521 522 case HFP_SUBEVENT_ATTACH_NUMBER_TO_VOICE_TAG: 523 printf("Attach number to voice tag. Sending '1234567\n"); 524 hfp_ag_send_phone_number_for_voice_tag(acl_handle, "1234567"); 525 break; 526 case HFP_SUBEVENT_TRANSMIT_DTMF_CODES: 527 printf("Send DTMF Codes: '%s'\n", hfp_subevent_transmit_dtmf_codes_get_dtmf(event)); 528 hfp_ag_send_dtmf_code_done(acl_handle); 529 break; 530 case HFP_SUBEVENT_CALL_ANSWERED: 531 printf("Call answered by HF\n"); 532 break; 533 default: 534 printf("Event not handled %u\n", hci_event_hfp_meta_get_subevent_code(event)); 535 break; 536 } 537 break; 538 case HCI_SCO_DATA_PACKET: 539 if (READ_SCO_CONNECTION_HANDLE(event) != sco_handle) break; 540 sco_demo_receive(event, event_size); 541 break; 542 default: 543 break; 544 } 545 } 546 547 static hfp_phone_number_t subscriber_number = { 548 129, "225577" 549 }; 550 551 /* @section Main Application Setup 552 * 553 * @text Listing MainConfiguration shows main application code. 554 * To run a HFP AG service you need to initialize the SDP, and to create and register HFP AG record with it. 555 * The packet_handler is used for sending commands to the HFP HF. It also receives the HFP HF's answers. 556 * The stdin_process callback allows for sending commands to the HFP HF. 557 * At the end the Bluetooth stack is started. 558 */ 559 560 /* LISTING_START(MainConfiguration): Setup HFP Audio Gateway */ 561 562 int btstack_main(int argc, const char * argv[]); 563 int btstack_main(int argc, const char * argv[]){ 564 (void)argc; 565 (void)argv; 566 567 sco_demo_init(); 568 569 gap_set_local_name("HFP AG Demo 00:00:00:00:00:00"); 570 gap_discoverable_control(1); 571 572 // L2CAP 573 l2cap_init(); 574 575 uint16_t supported_features = 576 (1<<HFP_AGSF_ESCO_S4) | 577 (1<<HFP_AGSF_HF_INDICATORS) | 578 (1<<HFP_AGSF_CODEC_NEGOTIATION) | 579 (1<<HFP_AGSF_EXTENDED_ERROR_RESULT_CODES) | 580 (1<<HFP_AGSF_ENHANCED_CALL_CONTROL) | 581 (1<<HFP_AGSF_ENHANCED_CALL_STATUS) | 582 (1<<HFP_AGSF_ABILITY_TO_REJECT_A_CALL) | 583 (1<<HFP_AGSF_IN_BAND_RING_TONE) | 584 (1<<HFP_AGSF_VOICE_RECOGNITION_FUNCTION) | 585 (1<<HFP_AGSF_THREE_WAY_CALLING); 586 int wide_band_speech = 1; 587 588 // HFP 589 rfcomm_init(); 590 hfp_ag_init(rfcomm_channel_nr); 591 hfp_ag_init_supported_features(supported_features); 592 hfp_ag_init_codecs(sizeof(codecs), codecs); 593 hfp_ag_init_ag_indicators(ag_indicators_nr, ag_indicators); 594 hfp_ag_init_hf_indicators(hf_indicators_nr, hf_indicators); 595 hfp_ag_init_call_hold_services(call_hold_services_nr, call_hold_services); 596 hfp_ag_set_subcriber_number_information(&subscriber_number, 1); 597 598 // SDP Server 599 sdp_init(); 600 memset(hfp_service_buffer, 0, sizeof(hfp_service_buffer)); 601 hfp_ag_create_sdp_record( hfp_service_buffer, 0x10001, rfcomm_channel_nr, hfp_ag_service_name, 0, supported_features, wide_band_speech); 602 printf("SDP service record size: %u\n", de_get_len( hfp_service_buffer)); 603 sdp_register_service(hfp_service_buffer); 604 605 // register for HCI events and SCO packets 606 hci_event_callback_registration.callback = &packet_handler; 607 hci_add_event_handler(&hci_event_callback_registration); 608 hci_register_sco_packet_handler(&packet_handler); 609 610 // register for HFP events 611 hfp_ag_register_packet_handler(&packet_handler); 612 613 // parse humand readable Bluetooth address 614 sscanf_bd_addr(device_addr_string, device_addr); 615 616 #ifdef HAVE_BTSTACK_STDIN 617 btstack_stdin_setup(stdin_process); 618 #endif 619 // turn on! 620 hci_power_control(HCI_POWER_ON); 621 return 0; 622 } 623 /* LISTING_END */ 624 /* EXAMPLE_END */ 625