xref: /btstack/example/hfp_ag_demo.c (revision cd5f23a3250874824c01a2b3326a9522fea3f99f)
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             if ((event_size > 3)
455                 && (event[3] != 0)
456                 && (hci_event_hfp_meta_get_subevent_code(event) != HFP_SUBEVENT_PLACE_CALL_WITH_NUMBER)
457                 && (hci_event_hfp_meta_get_subevent_code(event) != HFP_SUBEVENT_ATTACH_NUMBER_TO_VOICE_TAG)
458                 && (hci_event_hfp_meta_get_subevent_code(event) != HFP_SUBEVENT_TRANSMIT_DTMF_CODES)){
459                 printf("ERROR, status: %u\n", event[3]);
460                 return;
461             }
462 
463             switch (hci_event_hfp_meta_get_subevent_code(event)) {
464                 case HFP_SUBEVENT_SERVICE_LEVEL_CONNECTION_ESTABLISHED:
465                     status = hfp_subevent_service_level_connection_established_get_status(event);
466                     if (status){
467                         printf("Connection failed, staus 0x%02x\n", status);
468                         break;
469                     }
470                     acl_handle = hfp_subevent_service_level_connection_established_get_con_handle(event);
471                     hfp_subevent_service_level_connection_established_get_bd_addr(event, device_addr);
472                     printf("Service level connection established to %s.\n", bd_addr_to_str(device_addr));
473                     dump_supported_codecs();
474 #ifndef HAVE_BTSTACK_STDIN
475                     log_info("Establish Audio connection %s", bd_addr_to_str(device_addr));
476                     printf("Establish Audio connection %s...\n", bd_addr_to_str(device_addr));
477                     hfp_ag_establish_audio_connection(acl_handle);
478 #endif
479                     break;
480                 case HFP_SUBEVENT_SERVICE_LEVEL_CONNECTION_RELEASED:
481                     printf("Service level connection released.\n");
482                     acl_handle = HCI_CON_HANDLE_INVALID;
483                     break;
484                 case HFP_SUBEVENT_AUDIO_CONNECTION_ESTABLISHED:
485                     if (hfp_subevent_audio_connection_established_get_status(event)){
486                         printf("Audio connection establishment failed with status %u\n", hfp_subevent_audio_connection_established_get_status(event));
487                     } else {
488                         sco_handle = hfp_subevent_audio_connection_established_get_handle(event);
489                         printf("Audio connection established with SCO handle 0x%04x.\n", sco_handle);
490                         negotiated_codec = hfp_subevent_audio_connection_established_get_negotiated_codec(event);
491                         switch (negotiated_codec){
492                             case 0x01:
493                                 printf("Using CVSD codec.\n");
494                                 break;
495                             case 0x02:
496                                 printf("Using mSBC codec.\n");
497                                 break;
498                             default:
499                                 printf("Using unknown codec 0x%02x.\n", negotiated_codec);
500                                 break;
501                         }
502                         sco_demo_set_codec(negotiated_codec);
503                         hci_request_sco_can_send_now_event();
504                     }
505                     break;
506                 case HFP_SUBEVENT_AUDIO_CONNECTION_RELEASED:
507                     printf("Audio connection released\n");
508                     sco_handle = HCI_CON_HANDLE_INVALID;
509                     sco_demo_close();
510                     break;
511                 case HFP_SUBEVENT_START_RINGINIG:
512                     printf("Start Ringing\n");
513                     break;
514                 case HFP_SUBEVENT_STOP_RINGINIG:
515                     printf("Stop Ringing\n");
516                     break;
517                 case HFP_SUBEVENT_PLACE_CALL_WITH_NUMBER:
518                     printf("Outgoing call '%s'\n", hfp_subevent_place_call_with_number_get_number(event));
519                     // validate number
520                     if ( strcmp("1234567", hfp_subevent_place_call_with_number_get_number(event)) == 0
521                       || strcmp("7654321", hfp_subevent_place_call_with_number_get_number(event)) == 0
522                       || (memory_1_enabled && strcmp(">1", hfp_subevent_place_call_with_number_get_number(event)) == 0)){
523                         printf("Dialstring valid: accept call\n");
524                         hfp_ag_outgoing_call_accepted();
525                     } else {
526                         printf("Dialstring invalid: reject call\n");
527                         hfp_ag_outgoing_call_rejected();
528                     }
529                     break;
530 
531                 case HFP_SUBEVENT_ATTACH_NUMBER_TO_VOICE_TAG:
532                     printf("Attach number to voice tag. Sending '1234567\n");
533                     hfp_ag_send_phone_number_for_voice_tag(acl_handle, "1234567");
534                     break;
535                 case HFP_SUBEVENT_TRANSMIT_DTMF_CODES:
536                     printf("Send DTMF Codes: '%s'\n", hfp_subevent_transmit_dtmf_codes_get_dtmf(event));
537                     hfp_ag_send_dtmf_code_done(acl_handle);
538                     break;
539                 case HFP_SUBEVENT_CALL_ANSWERED:
540                     printf("Call answered by HF\n");
541                     break;
542                 default:
543                     printf("Event not handled %u\n", hci_event_hfp_meta_get_subevent_code(event));
544                     break;
545             }
546             break;
547         case HCI_SCO_DATA_PACKET:
548             if (READ_SCO_CONNECTION_HANDLE(event) != sco_handle) break;
549             sco_demo_receive(event, event_size);
550             break;
551         default:
552             break;
553     }
554 }
555 
556 static hfp_phone_number_t subscriber_number = {
557     129, "225577"
558 };
559 
560 /* @section Main Application Setup
561  *
562  * @text Listing MainConfiguration shows main application code.
563  * To run a HFP AG service you need to initialize the SDP, and to create and register HFP AG record with it.
564  * The packet_handler is used for sending commands to the HFP HF. It also receives the HFP HF's answers.
565  * The stdin_process callback allows for sending commands to the HFP HF.
566  * At the end the Bluetooth stack is started.
567  */
568 
569 /* LISTING_START(MainConfiguration): Setup HFP Audio Gateway */
570 
571 int btstack_main(int argc, const char * argv[]);
572 int btstack_main(int argc, const char * argv[]){
573     (void)argc;
574     (void)argv;
575 
576     sco_demo_init();
577 
578     gap_set_local_name("HFP AG Demo 00:00:00:00:00:00");
579     gap_discoverable_control(1);
580 
581     // L2CAP
582     l2cap_init();
583 
584     uint16_t supported_features                   =
585         (1<<HFP_AGSF_ESCO_S4)                     |
586         (1<<HFP_AGSF_HF_INDICATORS)               |
587         (1<<HFP_AGSF_CODEC_NEGOTIATION)           |
588         (1<<HFP_AGSF_EXTENDED_ERROR_RESULT_CODES) |
589         (1<<HFP_AGSF_ENHANCED_CALL_CONTROL)       |
590         (1<<HFP_AGSF_ENHANCED_CALL_STATUS)        |
591         (1<<HFP_AGSF_ABILITY_TO_REJECT_A_CALL)    |
592         (1<<HFP_AGSF_IN_BAND_RING_TONE)           |
593         (1<<HFP_AGSF_VOICE_RECOGNITION_FUNCTION)  |
594         (1<<HFP_AGSF_THREE_WAY_CALLING);
595     int wide_band_speech = 1;
596 
597     // HFP
598     rfcomm_init();
599     hfp_ag_init(rfcomm_channel_nr);
600     hfp_ag_init_supported_features(supported_features);
601     hfp_ag_init_codecs(sizeof(codecs), codecs);
602     hfp_ag_init_ag_indicators(ag_indicators_nr, ag_indicators);
603     hfp_ag_init_hf_indicators(hf_indicators_nr, hf_indicators);
604     hfp_ag_init_call_hold_services(call_hold_services_nr, call_hold_services);
605     hfp_ag_set_subcriber_number_information(&subscriber_number, 1);
606 
607     // SDP Server
608     sdp_init();
609     memset(hfp_service_buffer, 0, sizeof(hfp_service_buffer));
610     hfp_ag_create_sdp_record( hfp_service_buffer, 0x10001, rfcomm_channel_nr, hfp_ag_service_name, 0, supported_features, wide_band_speech);
611     printf("SDP service record size: %u\n", de_get_len( hfp_service_buffer));
612     sdp_register_service(hfp_service_buffer);
613 
614     // register for HCI events and SCO packets
615     hci_event_callback_registration.callback = &packet_handler;
616     hci_add_event_handler(&hci_event_callback_registration);
617     hci_register_sco_packet_handler(&packet_handler);
618 
619     // register for HFP events
620     hfp_ag_register_packet_handler(&packet_handler);
621 
622     // parse humand readable Bluetooth address
623     sscanf_bd_addr(device_addr_string, device_addr);
624 
625 #ifdef HAVE_BTSTACK_STDIN
626     btstack_stdin_setup(stdin_process);
627 #endif
628     // turn on!
629     hci_power_control(HCI_POWER_ON);
630     return 0;
631 }
632 /* LISTING_END */
633 /* EXAMPLE_END */
634