xref: /btstack/example/hfp_ag_demo.c (revision f11fd9a990fedbf11b7c70e38b9da44019506e13)
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 AG - Audio Gateway
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             default:
131                 btstack_assert(false);
132                 break;
133         }
134     }
135     printf("\n");
136     if (mSBC_skipped){
137         printf("mSBC codec disabled because eSCO not supported by local controller.\n");
138     }
139 }
140 
141 #ifdef HAVE_BTSTACK_STDIN
142 // Testig User Interface
143 static void show_usage(void){
144     bd_addr_t iut_address;
145     gap_local_bd_addr(iut_address);
146 
147     printf("\n--- Bluetooth HFP Audiogateway (AG) unit Test Console %s ---\n", bd_addr_to_str(iut_address));
148     printf("\n");
149 
150     printf("a - establish HFP connection to %s\n", bd_addr_to_str(device_addr));
151     // printf("A - release HFP connection\n");
152 
153     printf("b - establish AUDIO connection          | B - release AUDIO connection\n");
154     printf("c - simulate incoming call from 1234567 | C - simulate call from 1234567 dropped\n");
155     printf("d - report AG failure\n");
156     printf("D - delete all link keys\n");
157     printf("e - answer call on AG                   | E - reject call on AG\n");
158     printf("r - disable in-band ring tone           | R - enable in-band ring tone\n");
159     printf("f - Disable cellular network            | F - Enable cellular network\n");
160     printf("g - Set signal strength to 0            | G - Set signal strength to 5\n");
161     printf("h - Disable roaming                     | H - Enable roaming\n");
162     printf("i - Set battery level to 3              | I - Set battery level to 5\n");
163     printf("j - Answering call on remote side\n");
164     printf("k - Clear memory #1                     | K - Set memory #1\n");
165     printf("l - Clear last number                   | L - Set last number\n");
166     printf("m - simulate incoming call from 7654321\n");
167     // printf("M - simulate call from 7654321 dropped\n");
168     printf("n - Disable Voice Regocnition           | N - Enable Voice Recognition\n");
169     printf("o - Set speaker volume to 0  (minimum)  | O - Set speaker volume to 9  (default)\n");
170     printf("p - Set speaker volume to 12 (higher)   | P - Set speaker volume to 15 (maximum)\n");
171     printf("q - Set microphone gain to 0  (minimum) | Q - Set microphone gain to 9  (default)\n");
172     printf("s - Set microphone gain to 12 (higher)  | S - Set microphone gain to 15 (maximum)\n");
173     printf("t - terminate connection\n");
174     printf("u - join held call\n");
175     printf("v - discover nearby HF units\n");
176     printf("w - put incoming call on hold (Response and Hold)\n");
177     printf("x - accept held incoming call (Response and Hold)\n");
178     printf("X - reject held incoming call (Response and Hold)\n");
179     printf("---\n");
180 }
181 
182 static void stdin_process(char cmd){
183     switch (cmd){
184         case 'a':
185             log_info("USER:\'%c\'", cmd);
186             printf("Establish HFP service level connection to %s...\n", bd_addr_to_str(device_addr));
187             hfp_ag_establish_service_level_connection(device_addr);
188             break;
189         case 'A':
190             log_info("USER:\'%c\'", cmd);
191             printf("Release HFP service level connection.\n");
192             hfp_ag_release_service_level_connection(acl_handle);
193             break;
194         case 'Z':
195             log_info("USER:\'%c\'", cmd);
196             printf("Release HFP service level connection to %s...\n", bd_addr_to_str(device_addr));
197             hfp_ag_release_service_level_connection(acl_handle);
198             break;
199         case 'b':
200             log_info("USER:\'%c\'", cmd);
201             printf("Establish Audio connection %s...\n", bd_addr_to_str(device_addr));
202             hfp_ag_establish_audio_connection(acl_handle);
203             break;
204         case 'B':
205             log_info("USER:\'%c\'", cmd);
206             printf("Release Audio connection.\n");
207             hfp_ag_release_audio_connection(acl_handle);
208             break;
209         case 'c':
210             log_info("USER:\'%c\'", cmd);
211             printf("Simulate incoming call from 1234567\n");
212             hfp_ag_set_clip(129, "1234567");
213             hfp_ag_incoming_call();
214             break;
215         case 'D':
216             printf("Deleting all link keys\n");
217             gap_delete_all_link_keys();
218             break;
219         case 'm':
220             log_info("USER:\'%c\'", cmd);
221             printf("Simulate incoming call from 7654321\n");
222             hfp_ag_set_clip(129, "7654321");
223             hfp_ag_incoming_call();
224             break;
225         case 'C':
226             log_info("USER:\'%c\'", cmd);
227             printf("Simulate terminate call\n");
228             hfp_ag_call_dropped();
229             break;
230         case 'd':
231             log_info("USER:\'%c\'", cmd);
232             printf("Report AG failure\n");
233             hfp_ag_report_extended_audio_gateway_error_result_code(acl_handle, HFP_CME_ERROR_AG_FAILURE);
234             break;
235         case 'e':
236             log_info("USER:\'%c\'", cmd);
237             printf("Answer call on AG\n");
238             hfp_ag_answer_incoming_call();
239             break;
240         case 'E':
241             log_info("USER:\'%c\'", cmd);
242             printf("Reject call on AG\n");
243             hfp_ag_terminate_call();
244             break;
245         case 'f':
246             log_info("USER:\'%c\'", cmd);
247             printf("Disable cellular network\n");
248             hfp_ag_set_registration_status(0);
249             break;
250         case 'F':
251             log_info("USER:\'%c\'", cmd);
252             printf("Enable cellular network\n");
253             hfp_ag_set_registration_status(1);
254             break;
255         case 'g':
256             log_info("USER:\'%c\'", cmd);
257             printf("Set signal strength to 0\n");
258             hfp_ag_set_signal_strength(0);
259             break;
260         case 'G':
261             log_info("USER:\'%c\'", cmd);
262             printf("Set signal strength to 5\n");
263             hfp_ag_set_signal_strength(5);
264             break;
265         case 'h':
266             log_info("USER:\'%c\'", cmd);
267             printf("Disable roaming\n");
268             hfp_ag_set_roaming_status(0);
269             break;
270         case 'H':
271             log_info("USER:\'%c\'", cmd);
272             printf("Enable roaming\n");
273             hfp_ag_set_roaming_status(1);
274             break;
275         case 'i':
276             log_info("USER:\'%c\'", cmd);
277             printf("Set battery level to 3\n");
278             hfp_ag_set_battery_level(3);
279             break;
280         case 'I':
281             log_info("USER:\'%c\'", cmd);
282             printf("Set battery level to 5\n");
283             hfp_ag_set_battery_level(5);
284             break;
285         case 'j':
286             log_info("USER:\'%c\'", cmd);
287             printf("Answering call on remote side\n");
288             hfp_ag_outgoing_call_established();
289             break;
290         case 'r':
291             log_info("USER:\'%c\'", cmd);
292             printf("Disable in-band ring tone\n");
293             hfp_ag_set_use_in_band_ring_tone(0);
294             break;
295         case 'k':
296             log_info("USER:\'%c\'", cmd);
297             printf("Memory 1 cleared\n");
298             memory_1_enabled = 0;
299             break;
300         case 'K':
301             log_info("USER:\'%c\'", cmd);
302             printf("Memory 1 set\n");
303             memory_1_enabled = 1;
304             break;
305         case 'l':
306             log_info("USER:\'%c\'", cmd);
307             printf("Last dialed number cleared\n");
308             hfp_ag_clear_last_dialed_number();
309             break;
310         case 'L':
311             log_info("USER:\'%c\'", cmd);
312             printf("Outgoing call connected, ringing\n");
313             hfp_ag_outgoing_call_ringing();
314             break;
315         case 'n':
316             log_info("USER:\'%c\'", cmd);
317             printf("Disable Voice Recognition\n");
318             hfp_ag_activate_voice_recognition(acl_handle, 0);
319             break;
320         case 'N':
321             log_info("USER:\'%c\'", cmd);
322             printf("Enable Voice Recognition\n");
323             hfp_ag_activate_voice_recognition(acl_handle, 1);
324             break;
325         case 'o':
326             log_info("USER:\'%c\'", cmd);
327             printf("Set speaker gain to 0 (minimum)\n");
328             hfp_ag_set_speaker_gain(acl_handle, 0);
329             break;
330         case 'O':
331             log_info("USER:\'%c\'", cmd);
332             printf("Set speaker gain to 9 (default)\n");
333             hfp_ag_set_speaker_gain(acl_handle, 9);
334             break;
335         case 'p':
336             log_info("USER:\'%c\'", cmd);
337             printf("Set speaker gain to 12 (higher)\n");
338             hfp_ag_set_speaker_gain(acl_handle, 12);
339             break;
340         case 'P':
341             log_info("USER:\'%c\'", cmd);
342             printf("Set speaker gain to 15 (maximum)\n");
343             hfp_ag_set_speaker_gain(acl_handle, 15);
344             break;
345         case 'q':
346             log_info("USER:\'%c\'", cmd);
347             printf("Set microphone gain to 0\n");
348             hfp_ag_set_microphone_gain(acl_handle, 0);
349             break;
350         case 'Q':
351             log_info("USER:\'%c\'", cmd);
352             printf("Set microphone gain to 9\n");
353             hfp_ag_set_microphone_gain(acl_handle, 9);
354             break;
355         case 's':
356             log_info("USER:\'%c\'", cmd);
357             printf("Set microphone gain to 12\n");
358             hfp_ag_set_microphone_gain(acl_handle, 12);
359             break;
360         case 'S':
361             log_info("USER:\'%c\'", cmd);
362             printf("Set microphone gain to 15\n");
363             hfp_ag_set_microphone_gain(acl_handle, 15);
364             break;
365         case 'R':
366             log_info("USER:\'%c\'", cmd);
367             printf("Enable in-band ring tone\n");
368             hfp_ag_set_use_in_band_ring_tone(1);
369             break;
370         case 't':
371             log_info("USER:\'%c\'", cmd);
372             printf("Terminate HCI connection. 0x%2x\n", acl_handle);
373             gap_disconnect(acl_handle);
374             break;
375         case 'u':
376             log_info("USER:\'%c\'", cmd);
377             printf("Join held call\n");
378             hfp_ag_join_held_call();
379             break;
380         case 'v':
381             printf("Start scanning...\n");
382             gap_inquiry_start(INQUIRY_INTERVAL);
383             break;
384         case 'w':
385             log_info("USER:\'%c\'", cmd);
386             printf("AG: Put incoming call on hold (Response and Hold)\n");
387             hfp_ag_hold_incoming_call();
388             break;
389         case 'x':
390             log_info("USER:\'%c\'", cmd);
391             printf("AG: Accept held incoming call (Response and Hold)\n");
392             hfp_ag_accept_held_incoming_call();
393             break;
394         case 'X':
395             log_info("USER:\'%c\'", cmd);
396             printf("AG: Reject held incoming call (Response and Hold)\n");
397             hfp_ag_reject_held_incoming_call();
398             break;
399         default:
400             show_usage();
401             break;
402     }
403 }
404 #endif
405 
406 static void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t * event, uint16_t event_size){
407     UNUSED(channel);
408     bd_addr_t addr;
409     uint8_t status;
410     switch (packet_type){
411         case HCI_EVENT_PACKET:
412             switch(hci_event_packet_get_type(event)){
413 #ifndef HAVE_BTSTACK_STDIN
414                 case BTSTACK_EVENT_STATE:
415                     if (btstack_event_state_get_state(event) != HCI_STATE_WORKING) break;
416                     printf("Establish HFP AG service level connection to %s...\n", bd_addr_to_str(device_addr));
417                     hfp_ag_establish_service_level_connection(device_addr);
418                     break;
419 #endif
420                 case GAP_EVENT_INQUIRY_RESULT:
421                     gap_event_inquiry_result_get_bd_addr(event, addr);
422                     // print info
423                     printf("Device found: %s ",  bd_addr_to_str(addr));
424                     printf("with COD: 0x%06x, ", (unsigned int) gap_event_inquiry_result_get_class_of_device(event));
425                     if (gap_event_inquiry_result_get_rssi_available(event)){
426                         printf(", rssi %d dBm", (int8_t) gap_event_inquiry_result_get_rssi(event));
427                     }
428                     if (gap_event_inquiry_result_get_name_available(event)){
429                         char name_buffer[240];
430                         int name_len = gap_event_inquiry_result_get_name_len(event);
431                         memcpy(name_buffer, gap_event_inquiry_result_get_name(event), name_len);
432                         name_buffer[name_len] = 0;
433                         printf(", name '%s'", name_buffer);
434                     }
435                     printf("\n");
436                     break;
437                 case GAP_EVENT_INQUIRY_COMPLETE:
438                     printf("Inquiry scan complete.\n");
439                     break;
440                 case HCI_EVENT_SCO_CAN_SEND_NOW:
441                     sco_demo_send(sco_handle);
442                     break;
443                 case HCI_EVENT_COMMAND_COMPLETE:
444                     if (HCI_EVENT_IS_COMMAND_COMPLETE(event, hci_read_local_supported_features)){
445                         dump_supported_codecs();
446                     }
447                     break;
448                 default:
449                     break;
450             }
451 
452             if (hci_event_packet_get_type(event) != HCI_EVENT_HFP_META) return;
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 != ERROR_CODE_SUCCESS){
458                         printf("Connection failed, staus 0x%02x\n", status);
459                         break;
460                     }
461                     acl_handle = hfp_subevent_service_level_connection_established_get_acl_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) != ERROR_CODE_SUCCESS){
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_sco_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                     break;
535             }
536             break;
537         case HCI_SCO_DATA_PACKET:
538             if (READ_SCO_CONNECTION_HANDLE(event) != sco_handle) break;
539             sco_demo_receive(event, event_size);
540             break;
541         default:
542             break;
543     }
544 }
545 
546 static hfp_phone_number_t subscriber_number = {
547     129, "225577"
548 };
549 
550 /* @section Main Application Setup
551  *
552  * @text Listing MainConfiguration shows main application code.
553  * To run a HFP AG service you need to initialize the SDP, and to create and register HFP AG record with it.
554  * The packet_handler is used for sending commands to the HFP HF. It also receives the HFP HF's answers.
555  * The stdin_process callback allows for sending commands to the HFP HF.
556  * At the end the Bluetooth stack is started.
557  */
558 
559 /* LISTING_START(MainConfiguration): Setup HFP Audio Gateway */
560 
561 int btstack_main(int argc, const char * argv[]);
562 int btstack_main(int argc, const char * argv[]){
563     (void)argc;
564     (void)argv;
565 
566     sco_demo_init();
567 
568     gap_set_local_name("HFP AG Demo 00:00:00:00:00:00");
569     gap_discoverable_control(1);
570 
571     // L2CAP
572     l2cap_init();
573 
574     uint16_t supported_features                   =
575         (1<<HFP_AGSF_ESCO_S4)                     |
576         (1<<HFP_AGSF_HF_INDICATORS)               |
577         (1<<HFP_AGSF_CODEC_NEGOTIATION)           |
578         (1<<HFP_AGSF_EXTENDED_ERROR_RESULT_CODES) |
579         (1<<HFP_AGSF_ENHANCED_CALL_CONTROL)       |
580         (1<<HFP_AGSF_ENHANCED_CALL_STATUS)        |
581         (1<<HFP_AGSF_ABILITY_TO_REJECT_A_CALL)    |
582         (1<<HFP_AGSF_IN_BAND_RING_TONE)           |
583         (1<<HFP_AGSF_VOICE_RECOGNITION_FUNCTION)  |
584         (1<<HFP_AGSF_THREE_WAY_CALLING);
585     int wide_band_speech = 1;
586 
587     // HFP
588     rfcomm_init();
589     hfp_ag_init(rfcomm_channel_nr);
590     hfp_ag_init_supported_features(supported_features);
591     hfp_ag_init_codecs(sizeof(codecs), codecs);
592     hfp_ag_init_ag_indicators(ag_indicators_nr, ag_indicators);
593     hfp_ag_init_hf_indicators(hf_indicators_nr, hf_indicators);
594     hfp_ag_init_call_hold_services(call_hold_services_nr, call_hold_services);
595     hfp_ag_set_subcriber_number_information(&subscriber_number, 1);
596 
597     // SDP Server
598     sdp_init();
599     memset(hfp_service_buffer, 0, sizeof(hfp_service_buffer));
600     hfp_ag_create_sdp_record( hfp_service_buffer, 0x10001, rfcomm_channel_nr, hfp_ag_service_name, 0, supported_features, wide_band_speech);
601     printf("SDP service record size: %u\n", de_get_len( hfp_service_buffer));
602     sdp_register_service(hfp_service_buffer);
603 
604     // register for HCI events and SCO packets
605     hci_event_callback_registration.callback = &packet_handler;
606     hci_add_event_handler(&hci_event_callback_registration);
607     hci_register_sco_packet_handler(&packet_handler);
608 
609     // register for HFP events
610     hfp_ag_register_packet_handler(&packet_handler);
611 
612     // parse humand readable Bluetooth address
613     sscanf_bd_addr(device_addr_string, device_addr);
614 
615 #ifdef HAVE_BTSTACK_STDIN
616     btstack_stdin_setup(stdin_process);
617 #endif
618     // turn on!
619     hci_power_control(HCI_POWER_ON);
620     return 0;
621 }
622 /* LISTING_END */
623 /* EXAMPLE_END */
624