xref: /btstack/example/hfp_ag_demo.c (revision e64e0086b6e940726b732214f11d6320c5a5b42c)
1fffdd288SMatthias Ringwald /*
2fffdd288SMatthias Ringwald  * Copyright (C) 2014 BlueKitchen GmbH
3fffdd288SMatthias Ringwald  *
4fffdd288SMatthias Ringwald  * Redistribution and use in source and binary forms, with or without
5fffdd288SMatthias Ringwald  * modification, are permitted provided that the following conditions
6fffdd288SMatthias Ringwald  * are met:
7fffdd288SMatthias Ringwald  *
8fffdd288SMatthias Ringwald  * 1. Redistributions of source code must retain the above copyright
9fffdd288SMatthias Ringwald  *    notice, this list of conditions and the following disclaimer.
10fffdd288SMatthias Ringwald  * 2. Redistributions in binary form must reproduce the above copyright
11fffdd288SMatthias Ringwald  *    notice, this list of conditions and the following disclaimer in the
12fffdd288SMatthias Ringwald  *    documentation and/or other materials provided with the distribution.
13fffdd288SMatthias Ringwald  * 3. Neither the name of the copyright holders nor the names of
14fffdd288SMatthias Ringwald  *    contributors may be used to endorse or promote products derived
15fffdd288SMatthias Ringwald  *    from this software without specific prior written permission.
16fffdd288SMatthias Ringwald  * 4. Any redistribution, use, or modification is done solely for
17fffdd288SMatthias Ringwald  *    personal benefit and not for any commercial purpose or for
18fffdd288SMatthias Ringwald  *    monetary gain.
19fffdd288SMatthias Ringwald  *
20fffdd288SMatthias Ringwald  * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
21fffdd288SMatthias Ringwald  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
22fffdd288SMatthias Ringwald  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
23fffdd288SMatthias Ringwald  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
24fffdd288SMatthias Ringwald  * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
25fffdd288SMatthias Ringwald  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
26fffdd288SMatthias Ringwald  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
27fffdd288SMatthias Ringwald  * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
28fffdd288SMatthias Ringwald  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
29fffdd288SMatthias Ringwald  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
30fffdd288SMatthias Ringwald  * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
31fffdd288SMatthias Ringwald  * SUCH DAMAGE.
32fffdd288SMatthias Ringwald  *
33fffdd288SMatthias Ringwald  * Please inquire about commercial licensing options at
34fffdd288SMatthias Ringwald  * [email protected]
35fffdd288SMatthias Ringwald  *
36fffdd288SMatthias Ringwald  */
37fffdd288SMatthias Ringwald 
38fffdd288SMatthias Ringwald /*
39fffdd288SMatthias Ringwald  * hfp_ag_demo.c
40fffdd288SMatthias Ringwald  */
41fffdd288SMatthias Ringwald 
42fffdd288SMatthias Ringwald // *****************************************************************************
43fffdd288SMatthias Ringwald /* EXAMPLE_START(hfp_ag_demo): HFP Audio Gateway (AG) Demo
44fffdd288SMatthias Ringwald  *
45fffdd288SMatthias Ringwald  * @text This HFP Audio Gateway example demonstrates how to receive
46fffdd288SMatthias Ringwald  * an output from a remote HFP Hands-Free (HF) unit, and,
47d0755cd6SMatthias Ringwald  * if HAVE_POSIX_STDIN is defined, how to control the HFP HF.
48fffdd288SMatthias Ringwald  */
49fffdd288SMatthias Ringwald // *****************************************************************************
50fffdd288SMatthias Ringwald 
51fffdd288SMatthias Ringwald 
52fffdd288SMatthias Ringwald #include <stdint.h>
53fffdd288SMatthias Ringwald #include <stdio.h>
54fffdd288SMatthias Ringwald #include <stdlib.h>
55fffdd288SMatthias Ringwald #include <string.h>
56fffdd288SMatthias Ringwald #include <unistd.h>
57fffdd288SMatthias Ringwald 
58fffdd288SMatthias Ringwald #include "btstack.h"
59d0755cd6SMatthias Ringwald #ifdef HAVE_POSIX_STDIN
60fffdd288SMatthias Ringwald #include "stdin_support.h"
614af4141bSMatthias Ringwald #endif
62fffdd288SMatthias Ringwald 
63fffdd288SMatthias Ringwald 
64fffdd288SMatthias Ringwald uint8_t hfp_service_buffer[150];
65fffdd288SMatthias Ringwald const uint8_t    rfcomm_channel_nr = 1;
66fffdd288SMatthias Ringwald const char hfp_ag_service_name[] = "BTstack HFP AG Test";
67fffdd288SMatthias Ringwald 
68*e64e0086SMatthias Ringwald // PTS
69*e64e0086SMatthias Ringwald // static bd_addr_t device_addr = {0x00,0x15,0x83,0x5F,0x9D,0x46};
70*e64e0086SMatthias Ringwald // BT-201
71*e64e0086SMatthias Ringwald static bd_addr_t device_addr = {0x00, 0x07, 0xB0, 0x83, 0x02, 0x5E};
72fffdd288SMatthias Ringwald 
73fffdd288SMatthias Ringwald static uint8_t codecs[1] = {HFP_CODEC_CVSD};
74fffdd288SMatthias Ringwald static uint16_t handle = -1;
75fffdd288SMatthias Ringwald static int memory_1_enabled = 1;
76fffdd288SMatthias Ringwald 
77fffdd288SMatthias Ringwald static int ag_indicators_nr = 7;
78fffdd288SMatthias Ringwald static hfp_ag_indicator_t ag_indicators[] = {
79fffdd288SMatthias Ringwald     // index, name, min range, max range, status, mandatory, enabled, status changed
80fffdd288SMatthias Ringwald     {1, "service",   0, 1, 1, 0, 0, 0},
81fffdd288SMatthias Ringwald     {2, "call",      0, 1, 0, 1, 1, 0},
82fffdd288SMatthias Ringwald     {3, "callsetup", 0, 3, 0, 1, 1, 0},
83fffdd288SMatthias Ringwald     {4, "battchg",   0, 5, 3, 0, 0, 0},
84fffdd288SMatthias Ringwald     {5, "signal",    0, 5, 5, 0, 1, 0},
85fffdd288SMatthias Ringwald     {6, "roam",      0, 1, 0, 0, 1, 0},
86fffdd288SMatthias Ringwald     {7, "callheld",  0, 2, 0, 1, 1, 0}
87fffdd288SMatthias Ringwald };
88fffdd288SMatthias Ringwald 
89fffdd288SMatthias Ringwald static int call_hold_services_nr = 5;
90fffdd288SMatthias Ringwald static const char* call_hold_services[] = {"1", "1x", "2", "2x", "3"};
91fffdd288SMatthias Ringwald 
92fffdd288SMatthias Ringwald static int hf_indicators_nr = 2;
93fffdd288SMatthias Ringwald static hfp_generic_status_indicator_t hf_indicators[] = {
94fffdd288SMatthias Ringwald     {1, 1},
95fffdd288SMatthias Ringwald     {2, 1},
96fffdd288SMatthias Ringwald };
97fffdd288SMatthias Ringwald 
98fffdd288SMatthias Ringwald char cmd;
99fffdd288SMatthias Ringwald 
100fffdd288SMatthias Ringwald // GAP INQUIRY
101fffdd288SMatthias Ringwald 
102fffdd288SMatthias Ringwald #define MAX_DEVICES 10
103fffdd288SMatthias Ringwald enum DEVICE_STATE { REMOTE_NAME_REQUEST, REMOTE_NAME_INQUIRED, REMOTE_NAME_FETCHED };
104fffdd288SMatthias Ringwald struct device {
105fffdd288SMatthias Ringwald     bd_addr_t  address;
106fffdd288SMatthias Ringwald     uint16_t   clockOffset;
107fffdd288SMatthias Ringwald     uint32_t   classOfDevice;
108fffdd288SMatthias Ringwald     uint8_t    pageScanRepetitionMode;
109fffdd288SMatthias Ringwald     uint8_t    rssi;
110fffdd288SMatthias Ringwald     enum DEVICE_STATE  state;
111fffdd288SMatthias Ringwald };
112fffdd288SMatthias Ringwald 
113fffdd288SMatthias Ringwald #define INQUIRY_INTERVAL 5
114fffdd288SMatthias Ringwald struct device devices[MAX_DEVICES];
115fffdd288SMatthias Ringwald int deviceCount = 0;
116fffdd288SMatthias Ringwald 
117fffdd288SMatthias Ringwald 
118fffdd288SMatthias Ringwald enum STATE {INIT, W4_INQUIRY_MODE_COMPLETE, ACTIVE} ;
119fffdd288SMatthias Ringwald enum STATE state = INIT;
120fffdd288SMatthias Ringwald 
121fffdd288SMatthias Ringwald 
122fffdd288SMatthias Ringwald static int getDeviceIndexForAddress( bd_addr_t addr){
123fffdd288SMatthias Ringwald     int j;
124fffdd288SMatthias Ringwald     for (j=0; j< deviceCount; j++){
125fffdd288SMatthias Ringwald         if (bd_addr_cmp(addr, devices[j].address) == 0){
126fffdd288SMatthias Ringwald             return j;
127fffdd288SMatthias Ringwald         }
128fffdd288SMatthias Ringwald     }
129fffdd288SMatthias Ringwald     return -1;
130fffdd288SMatthias Ringwald }
131fffdd288SMatthias Ringwald 
132d0755cd6SMatthias Ringwald #ifdef HAVE_POSIX_STDIN
133fffdd288SMatthias Ringwald static void start_scan(void){
134fffdd288SMatthias Ringwald     printf("Starting inquiry scan..\n");
135fffdd288SMatthias Ringwald     hci_send_cmd(&hci_inquiry, HCI_INQUIRY_LAP, INQUIRY_INTERVAL, 0);
136fffdd288SMatthias Ringwald }
137fffdd288SMatthias Ringwald #endif
138fffdd288SMatthias Ringwald 
139fffdd288SMatthias Ringwald static int has_more_remote_name_requests(void){
140fffdd288SMatthias Ringwald     int i;
141fffdd288SMatthias Ringwald     for (i=0;i<deviceCount;i++) {
142fffdd288SMatthias Ringwald         if (devices[i].state == REMOTE_NAME_REQUEST) return 1;
143fffdd288SMatthias Ringwald     }
144fffdd288SMatthias Ringwald     return 0;
145fffdd288SMatthias Ringwald }
146fffdd288SMatthias Ringwald 
147fffdd288SMatthias Ringwald static void do_next_remote_name_request(void){
148fffdd288SMatthias Ringwald     int i;
149fffdd288SMatthias Ringwald     for (i=0;i<deviceCount;i++) {
150fffdd288SMatthias Ringwald         // remote name request
151fffdd288SMatthias Ringwald         if (devices[i].state == REMOTE_NAME_REQUEST){
152fffdd288SMatthias Ringwald             devices[i].state = REMOTE_NAME_INQUIRED;
153fffdd288SMatthias Ringwald             printf("Get remote name of %s...\n", bd_addr_to_str(devices[i].address));
154fffdd288SMatthias Ringwald             hci_send_cmd(&hci_remote_name_request, devices[i].address,
155fffdd288SMatthias Ringwald                         devices[i].pageScanRepetitionMode, 0, devices[i].clockOffset | 0x8000);
156fffdd288SMatthias Ringwald             return;
157fffdd288SMatthias Ringwald         }
158fffdd288SMatthias Ringwald     }
159fffdd288SMatthias Ringwald }
160fffdd288SMatthias Ringwald 
161fffdd288SMatthias Ringwald static void continue_remote_names(void){
162fffdd288SMatthias Ringwald     // don't get remote names for testing
163fffdd288SMatthias Ringwald     if (has_more_remote_name_requests()){
164fffdd288SMatthias Ringwald         do_next_remote_name_request();
165fffdd288SMatthias Ringwald         return;
166fffdd288SMatthias Ringwald     }
167fffdd288SMatthias Ringwald     // try to find PTS
168fffdd288SMatthias Ringwald     int i;
169fffdd288SMatthias Ringwald     for (i=0;i<deviceCount;i++){
170fffdd288SMatthias Ringwald         if (memcmp(devices[i].address, device_addr, 6) == 0){
171fffdd288SMatthias Ringwald             printf("Inquiry scan over, successfully found PTS at index %u\nReady to connect to it.\n", i);
172fffdd288SMatthias Ringwald             return;
173fffdd288SMatthias Ringwald         }
174fffdd288SMatthias Ringwald     }
175fffdd288SMatthias Ringwald     printf("Inquiry scan over but PTS not found :(\n");
176fffdd288SMatthias Ringwald }
177fffdd288SMatthias Ringwald 
178fffdd288SMatthias Ringwald static void inquiry_packet_handler (uint8_t packet_type, uint8_t *packet, uint16_t size){
179fffdd288SMatthias Ringwald     bd_addr_t addr;
180fffdd288SMatthias Ringwald     int i;
181fffdd288SMatthias Ringwald     int numResponses;
182fffdd288SMatthias Ringwald     int index;
183fffdd288SMatthias Ringwald 
184fffdd288SMatthias Ringwald     // printf("packet_handler: pt: 0x%02x, packet[0]: 0x%02x\n", packet_type, packet[0]);
185fffdd288SMatthias Ringwald     if (packet_type != HCI_EVENT_PACKET) return;
186fffdd288SMatthias Ringwald 
187fffdd288SMatthias Ringwald     uint8_t event = packet[0];
188fffdd288SMatthias Ringwald 
189fffdd288SMatthias Ringwald     switch(event){
190fffdd288SMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT:
191fffdd288SMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:{
192f8744deaSMilanka Ringwald             numResponses = hci_event_inquiry_result_get_num_responses(packet);
193fffdd288SMatthias Ringwald             int offset = 3;
194fffdd288SMatthias Ringwald             for (i=0; i<numResponses && deviceCount < MAX_DEVICES;i++){
195*e64e0086SMatthias Ringwald                 reverse_bd_addr(&packet[offset], addr);
196fffdd288SMatthias Ringwald                 offset += 6;
197fffdd288SMatthias Ringwald                 index = getDeviceIndexForAddress(addr);
198fffdd288SMatthias Ringwald                 if (index >= 0) continue;   // already in our list
199fffdd288SMatthias Ringwald                 memcpy(devices[deviceCount].address, addr, 6);
200fffdd288SMatthias Ringwald 
201fffdd288SMatthias Ringwald                 devices[deviceCount].pageScanRepetitionMode = packet[offset];
202fffdd288SMatthias Ringwald                 offset += 1;
203fffdd288SMatthias Ringwald 
204fffdd288SMatthias Ringwald                 if (event == HCI_EVENT_INQUIRY_RESULT){
205fffdd288SMatthias Ringwald                     offset += 2; // Reserved + Reserved
206fffdd288SMatthias Ringwald                     devices[deviceCount].classOfDevice = little_endian_read_24(packet, offset);
207fffdd288SMatthias Ringwald                     offset += 3;
208fffdd288SMatthias Ringwald                     devices[deviceCount].clockOffset =   little_endian_read_16(packet, offset) & 0x7fff;
209fffdd288SMatthias Ringwald                     offset += 2;
210fffdd288SMatthias Ringwald                     devices[deviceCount].rssi  = 0;
211fffdd288SMatthias Ringwald                 } else {
212fffdd288SMatthias Ringwald                     offset += 1; // Reserved
213fffdd288SMatthias Ringwald                     devices[deviceCount].classOfDevice = little_endian_read_24(packet, offset);
214fffdd288SMatthias Ringwald                     offset += 3;
215fffdd288SMatthias Ringwald                     devices[deviceCount].clockOffset =   little_endian_read_16(packet, offset) & 0x7fff;
216fffdd288SMatthias Ringwald                     offset += 2;
217fffdd288SMatthias Ringwald                     devices[deviceCount].rssi  = packet[offset];
218fffdd288SMatthias Ringwald                     offset += 1;
219fffdd288SMatthias Ringwald                 }
220fffdd288SMatthias Ringwald                 devices[deviceCount].state = REMOTE_NAME_REQUEST;
221fffdd288SMatthias Ringwald                 printf("Device #%u found: %s with COD: 0x%06x, pageScan %d, clock offset 0x%04x, rssi 0x%02x\n",
222fffdd288SMatthias Ringwald                     deviceCount, bd_addr_to_str(addr),
223fffdd288SMatthias Ringwald                     devices[deviceCount].classOfDevice, devices[deviceCount].pageScanRepetitionMode,
224fffdd288SMatthias Ringwald                     devices[deviceCount].clockOffset, devices[deviceCount].rssi);
225fffdd288SMatthias Ringwald                 deviceCount++;
226fffdd288SMatthias Ringwald             }
227fffdd288SMatthias Ringwald 
228fffdd288SMatthias Ringwald             break;
229fffdd288SMatthias Ringwald         }
230fffdd288SMatthias Ringwald         case HCI_EVENT_INQUIRY_COMPLETE:
231fffdd288SMatthias Ringwald             for (i=0;i<deviceCount;i++) {
232fffdd288SMatthias Ringwald                 // retry remote name request
233fffdd288SMatthias Ringwald                 if (devices[i].state == REMOTE_NAME_INQUIRED)
234fffdd288SMatthias Ringwald                     devices[i].state = REMOTE_NAME_REQUEST;
235fffdd288SMatthias Ringwald             }
236fffdd288SMatthias Ringwald             continue_remote_names();
237fffdd288SMatthias Ringwald             break;
238fffdd288SMatthias Ringwald 
239fffdd288SMatthias Ringwald         case HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE:
240*e64e0086SMatthias Ringwald             reverse_bd_addr(&packet[3], addr);
241fffdd288SMatthias Ringwald             index = getDeviceIndexForAddress(addr);
242fffdd288SMatthias Ringwald             if (index >= 0) {
243fffdd288SMatthias Ringwald                 if (packet[2] == 0) {
244fffdd288SMatthias Ringwald                     printf("Name: '%s'\n", &packet[9]);
245fffdd288SMatthias Ringwald                     devices[index].state = REMOTE_NAME_FETCHED;
246fffdd288SMatthias Ringwald                 } else {
247fffdd288SMatthias Ringwald                     printf("Failed to get name: page timeout\n");
248fffdd288SMatthias Ringwald                 }
249fffdd288SMatthias Ringwald             }
250fffdd288SMatthias Ringwald             continue_remote_names();
251fffdd288SMatthias Ringwald             break;
252fffdd288SMatthias Ringwald 
253fffdd288SMatthias Ringwald         default:
254fffdd288SMatthias Ringwald             break;
255fffdd288SMatthias Ringwald     }
256fffdd288SMatthias Ringwald }
257fffdd288SMatthias Ringwald // GAP INQUIRY END
258d0755cd6SMatthias Ringwald #ifdef HAVE_POSIX_STDIN
259fffdd288SMatthias Ringwald 
260fffdd288SMatthias Ringwald // prototypes
26135833313SMatthias Ringwald static void show_usage(void);
262fffdd288SMatthias Ringwald 
263fffdd288SMatthias Ringwald // Testig User Interface
264fffdd288SMatthias Ringwald static void show_usage(void){
265*e64e0086SMatthias Ringwald     bd_addr_t iut_address;
266*e64e0086SMatthias Ringwald     gap_local_bd_addr(iut_address);
267*e64e0086SMatthias Ringwald 
268*e64e0086SMatthias Ringwald     printf("\n--- Bluetooth HFP Audiogateway (AG) unit Test Console %s ---\n", bd_addr_to_str(iut_address));
269fffdd288SMatthias Ringwald     printf("---\n");
270fffdd288SMatthias Ringwald 
271fffdd288SMatthias Ringwald     printf("a - establish HFP connection to PTS module\n");
272fffdd288SMatthias Ringwald     // printf("A - release HFP connection to PTS module\n");
273fffdd288SMatthias Ringwald 
274fffdd288SMatthias Ringwald     printf("b - establish AUDIO connection\n");
275fffdd288SMatthias Ringwald     printf("B - release AUDIO connection\n");
276fffdd288SMatthias Ringwald 
277fffdd288SMatthias Ringwald     printf("c - simulate incoming call from 1234567\n");
278fffdd288SMatthias Ringwald     printf("C - simulate call from 1234567 dropped\n");
279fffdd288SMatthias Ringwald 
280fffdd288SMatthias Ringwald     printf("d - report AG failure\n");
281fffdd288SMatthias Ringwald 
282fffdd288SMatthias Ringwald     printf("e - answer call on AG\n");
283fffdd288SMatthias Ringwald     printf("E - reject call on AG\n");
284fffdd288SMatthias Ringwald 
285fffdd288SMatthias Ringwald     printf("r - disable in-band ring tone\n");
286fffdd288SMatthias Ringwald     printf("R - enable in-band ring tone\n");
287fffdd288SMatthias Ringwald 
288fffdd288SMatthias Ringwald     printf("f - Disable cellular network\n");
289fffdd288SMatthias Ringwald     printf("F - Enable cellular network\n");
290fffdd288SMatthias Ringwald 
291fffdd288SMatthias Ringwald     printf("g - Set signal strength to 0\n");
292fffdd288SMatthias Ringwald     printf("G - Set signal strength to 5\n");
293fffdd288SMatthias Ringwald 
294fffdd288SMatthias Ringwald     printf("h - Disable roaming\n");
295fffdd288SMatthias Ringwald     printf("H - Enable roaming\n");
296fffdd288SMatthias Ringwald 
297fffdd288SMatthias Ringwald     printf("i - Set battery level to 3\n");
298fffdd288SMatthias Ringwald     printf("I - Set battery level to 5\n");
299fffdd288SMatthias Ringwald 
300fffdd288SMatthias Ringwald     printf("j - Answering call on remote side\n");
301fffdd288SMatthias Ringwald 
302fffdd288SMatthias Ringwald     printf("k - Clear memory #1\n");
303fffdd288SMatthias Ringwald     printf("K - Set memory #1\n");
304fffdd288SMatthias Ringwald 
305fffdd288SMatthias Ringwald     printf("l - Clear last number\n");
306fffdd288SMatthias Ringwald     printf("L - Set last number\n");
307fffdd288SMatthias Ringwald 
308fffdd288SMatthias Ringwald     printf("m - simulate incoming call from 7654321\n");
309fffdd288SMatthias Ringwald     // printf("M - simulate call from 7654321 dropped\n");
310fffdd288SMatthias Ringwald 
311fffdd288SMatthias Ringwald     printf("n - Disable Voice Regocnition\n");
312fffdd288SMatthias Ringwald     printf("N - Enable Voice Recognition\n");
313fffdd288SMatthias Ringwald 
314fffdd288SMatthias Ringwald     printf("o - Set speaker volume to 0  (minimum)\n");
315fffdd288SMatthias Ringwald     printf("O - Set speaker volume to 9  (default)\n");
316fffdd288SMatthias Ringwald     printf("p - Set speaker volume to 12 (higher)\n");
317fffdd288SMatthias Ringwald     printf("P - Set speaker volume to 15 (maximum)\n");
318fffdd288SMatthias Ringwald 
319fffdd288SMatthias Ringwald     printf("q - Set microphone gain to 0  (minimum)\n");
320fffdd288SMatthias Ringwald     printf("Q - Set microphone gain to 9  (default)\n");
321fffdd288SMatthias Ringwald     printf("s - Set microphone gain to 12 (higher)\n");
322fffdd288SMatthias Ringwald     printf("S - Set microphone gain to 15 (maximum)\n");
323fffdd288SMatthias Ringwald 
324fffdd288SMatthias Ringwald     printf("t - terminate connection\n");
325fffdd288SMatthias Ringwald     printf("u - join held call\n");
326fffdd288SMatthias Ringwald     printf("v - discover nearby HF units\n");
327fffdd288SMatthias Ringwald     printf("w - put incoming call on hold (Response and Hold)\n");
328fffdd288SMatthias Ringwald     printf("x - accept held incoming call (Response and Hold)\n");
329fffdd288SMatthias Ringwald     printf("X - reject held incoming call (Response and Hold)\n");
330fffdd288SMatthias Ringwald 
331fffdd288SMatthias Ringwald     printf("---\n");
332fffdd288SMatthias Ringwald     printf("Ctrl-c - exit\n");
333fffdd288SMatthias Ringwald     printf("---\n");
334fffdd288SMatthias Ringwald }
335fffdd288SMatthias Ringwald 
3364af4141bSMatthias Ringwald static void stdin_process(btstack_data_source_t *ds, btstack_data_source_callback_type_t callback_type){
337fffdd288SMatthias Ringwald     read(ds->fd, &cmd, 1);
338fffdd288SMatthias Ringwald     switch (cmd){
339fffdd288SMatthias Ringwald         case 'a':
340fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
341fffdd288SMatthias Ringwald             printf("Establish HFP service level connection to PTS module %s...\n", bd_addr_to_str(device_addr));
342fffdd288SMatthias Ringwald             hfp_ag_establish_service_level_connection(device_addr);
343fffdd288SMatthias Ringwald             break;
344fffdd288SMatthias Ringwald         case 'A':
345fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
346fffdd288SMatthias Ringwald             printf("Release HFP service level connection.\n");
347fffdd288SMatthias Ringwald             hfp_ag_release_service_level_connection(device_addr);
348fffdd288SMatthias Ringwald             break;
349fffdd288SMatthias Ringwald         case 'Z':
350fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
351fffdd288SMatthias Ringwald             printf("Release HFP service level connection to %s...\n", bd_addr_to_str(device_addr));
352fffdd288SMatthias Ringwald             hfp_ag_release_service_level_connection(device_addr);
353fffdd288SMatthias Ringwald             break;
354fffdd288SMatthias Ringwald         case 'b':
355fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
356fffdd288SMatthias Ringwald             printf("Establish Audio connection %s...\n", bd_addr_to_str(device_addr));
357fffdd288SMatthias Ringwald             hfp_ag_establish_audio_connection(device_addr);
358fffdd288SMatthias Ringwald             break;
359fffdd288SMatthias Ringwald         case 'B':
360fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
361fffdd288SMatthias Ringwald             printf("Release Audio connection.\n");
362fffdd288SMatthias Ringwald             hfp_ag_release_audio_connection(device_addr);
363fffdd288SMatthias Ringwald             break;
364fffdd288SMatthias Ringwald         case 'c':
365fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
366fffdd288SMatthias Ringwald             printf("Simulate incoming call from 1234567\n");
367fffdd288SMatthias Ringwald             hfp_ag_set_clip(129, "1234567");
368fffdd288SMatthias Ringwald             hfp_ag_incoming_call();
369fffdd288SMatthias Ringwald             break;
370fffdd288SMatthias Ringwald         case 'm':
371fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
372fffdd288SMatthias Ringwald             printf("Simulate incoming call from 7654321\n");
373fffdd288SMatthias Ringwald             hfp_ag_set_clip(129, "7654321");
374fffdd288SMatthias Ringwald             hfp_ag_incoming_call();
375fffdd288SMatthias Ringwald             break;
376fffdd288SMatthias Ringwald         case 'C':
377fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
378fffdd288SMatthias Ringwald             printf("Simulate terminate call\n");
379fffdd288SMatthias Ringwald             hfp_ag_call_dropped();
380fffdd288SMatthias Ringwald             break;
381fffdd288SMatthias Ringwald         case 'd':
382fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
383fffdd288SMatthias Ringwald             printf("Report AG failure\n");
384fffdd288SMatthias Ringwald             hfp_ag_report_extended_audio_gateway_error_result_code(device_addr, HFP_CME_ERROR_AG_FAILURE);
385fffdd288SMatthias Ringwald             break;
386fffdd288SMatthias Ringwald         case 'e':
387fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
388fffdd288SMatthias Ringwald             printf("Answer call on AG\n");
389fffdd288SMatthias Ringwald             hfp_ag_answer_incoming_call();
390fffdd288SMatthias Ringwald             break;
391fffdd288SMatthias Ringwald         case 'E':
392fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
393fffdd288SMatthias Ringwald             printf("Reject call on AG\n");
394fffdd288SMatthias Ringwald             hfp_ag_terminate_call();
395fffdd288SMatthias Ringwald             break;
396fffdd288SMatthias Ringwald         case 'f':
397fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
398fffdd288SMatthias Ringwald             printf("Disable cellular network\n");
399fffdd288SMatthias Ringwald             hfp_ag_set_registration_status(0);
400fffdd288SMatthias Ringwald             break;
401fffdd288SMatthias Ringwald         case 'F':
402fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
403fffdd288SMatthias Ringwald             printf("Enable cellular network\n");
404fffdd288SMatthias Ringwald             hfp_ag_set_registration_status(1);
405fffdd288SMatthias Ringwald             break;
406fffdd288SMatthias Ringwald         case 'g':
407fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
408fffdd288SMatthias Ringwald             printf("Set signal strength to 0\n");
409fffdd288SMatthias Ringwald             hfp_ag_set_signal_strength(0);
410fffdd288SMatthias Ringwald             break;
411fffdd288SMatthias Ringwald         case 'G':
412fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
413fffdd288SMatthias Ringwald             printf("Set signal strength to 5\n");
414fffdd288SMatthias Ringwald             hfp_ag_set_signal_strength(5);
415fffdd288SMatthias Ringwald             break;
416fffdd288SMatthias Ringwald         case 'h':
417fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
418fffdd288SMatthias Ringwald             printf("Disable roaming\n");
419fffdd288SMatthias Ringwald             hfp_ag_set_roaming_status(0);
420fffdd288SMatthias Ringwald             break;
421fffdd288SMatthias Ringwald         case 'H':
422fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
423fffdd288SMatthias Ringwald             printf("Enable roaming\n");
424fffdd288SMatthias Ringwald             hfp_ag_set_roaming_status(1);
425fffdd288SMatthias Ringwald             break;
426fffdd288SMatthias Ringwald         case 'i':
427fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
428fffdd288SMatthias Ringwald             printf("Set battery level to 3\n");
429fffdd288SMatthias Ringwald             hfp_ag_set_battery_level(3);
430fffdd288SMatthias Ringwald             break;
431fffdd288SMatthias Ringwald         case 'I':
432fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
433fffdd288SMatthias Ringwald             printf("Set battery level to 5\n");
434fffdd288SMatthias Ringwald             hfp_ag_set_battery_level(5);
435fffdd288SMatthias Ringwald             break;
436fffdd288SMatthias Ringwald         case 'j':
437fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
438fffdd288SMatthias Ringwald             printf("Answering call on remote side\n");
439fffdd288SMatthias Ringwald             hfp_ag_outgoing_call_established();
440fffdd288SMatthias Ringwald             break;
441fffdd288SMatthias Ringwald         case 'r':
442fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
443fffdd288SMatthias Ringwald             printf("Disable in-band ring tone\n");
444fffdd288SMatthias Ringwald             hfp_ag_set_use_in_band_ring_tone(0);
445fffdd288SMatthias Ringwald             break;
446fffdd288SMatthias Ringwald         case 'k':
447fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
448fffdd288SMatthias Ringwald             printf("Memory 1 cleared\n");
449fffdd288SMatthias Ringwald             memory_1_enabled = 0;
450fffdd288SMatthias Ringwald             break;
451fffdd288SMatthias Ringwald         case 'K':
452fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
453fffdd288SMatthias Ringwald             printf("Memory 1 set\n");
454fffdd288SMatthias Ringwald             memory_1_enabled = 1;
455fffdd288SMatthias Ringwald             break;
456fffdd288SMatthias Ringwald         case 'l':
457fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
458fffdd288SMatthias Ringwald             printf("Last dialed number cleared\n");
459fffdd288SMatthias Ringwald             hfp_ag_clear_last_dialed_number();
460fffdd288SMatthias Ringwald             break;
461fffdd288SMatthias Ringwald         case 'L':
462fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
463fffdd288SMatthias Ringwald             printf("Outgoing call connected, ringing\n");
464fffdd288SMatthias Ringwald             hfp_ag_outgoing_call_ringing();
465fffdd288SMatthias Ringwald             break;
466fffdd288SMatthias Ringwald         case 'n':
467fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
468fffdd288SMatthias Ringwald             printf("Disable Voice Recognition\n");
469fffdd288SMatthias Ringwald             hfp_ag_activate_voice_recognition(device_addr, 0);
470fffdd288SMatthias Ringwald             break;
471fffdd288SMatthias Ringwald         case 'N':
472fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
473fffdd288SMatthias Ringwald             printf("Enable Voice Recognition\n");
474fffdd288SMatthias Ringwald             hfp_ag_activate_voice_recognition(device_addr, 1);
475fffdd288SMatthias Ringwald             break;
476fffdd288SMatthias Ringwald         case 'o':
477fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
478fffdd288SMatthias Ringwald             printf("Set speaker gain to 0 (minimum)\n");
479fffdd288SMatthias Ringwald             hfp_ag_set_speaker_gain(device_addr, 0);
480fffdd288SMatthias Ringwald             break;
481fffdd288SMatthias Ringwald         case 'O':
482fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
483fffdd288SMatthias Ringwald             printf("Set speaker gain to 9 (default)\n");
484fffdd288SMatthias Ringwald             hfp_ag_set_speaker_gain(device_addr, 9);
485fffdd288SMatthias Ringwald             break;
486fffdd288SMatthias Ringwald         case 'p':
487fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
488fffdd288SMatthias Ringwald             printf("Set speaker gain to 12 (higher)\n");
489fffdd288SMatthias Ringwald             hfp_ag_set_speaker_gain(device_addr, 12);
490fffdd288SMatthias Ringwald             break;
491fffdd288SMatthias Ringwald         case 'P':
492fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
493fffdd288SMatthias Ringwald             printf("Set speaker gain to 15 (maximum)\n");
494fffdd288SMatthias Ringwald             hfp_ag_set_speaker_gain(device_addr, 15);
495fffdd288SMatthias Ringwald             break;
496fffdd288SMatthias Ringwald         case 'q':
497fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
498fffdd288SMatthias Ringwald             printf("Set microphone gain to 0\n");
499fffdd288SMatthias Ringwald             hfp_ag_set_microphone_gain(device_addr, 0);
500fffdd288SMatthias Ringwald             break;
501fffdd288SMatthias Ringwald         case 'Q':
502fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
503fffdd288SMatthias Ringwald             printf("Set microphone gain to 9\n");
504fffdd288SMatthias Ringwald             hfp_ag_set_microphone_gain(device_addr, 9);
505fffdd288SMatthias Ringwald             break;
506fffdd288SMatthias Ringwald         case 's':
507fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
508fffdd288SMatthias Ringwald             printf("Set microphone gain to 12\n");
509fffdd288SMatthias Ringwald             hfp_ag_set_microphone_gain(device_addr, 12);
510fffdd288SMatthias Ringwald             break;
511fffdd288SMatthias Ringwald         case 'S':
512fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
513fffdd288SMatthias Ringwald             printf("Set microphone gain to 15\n");
514fffdd288SMatthias Ringwald             hfp_ag_set_microphone_gain(device_addr, 15);
515fffdd288SMatthias Ringwald             break;
516fffdd288SMatthias Ringwald         case 'R':
517fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
518fffdd288SMatthias Ringwald             printf("Enable in-band ring tone\n");
519fffdd288SMatthias Ringwald             hfp_ag_set_use_in_band_ring_tone(1);
520fffdd288SMatthias Ringwald             break;
521fffdd288SMatthias Ringwald         case 't':
522fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
523*e64e0086SMatthias Ringwald             printf("Terminate HCI connection. 0x%2x\n", handle);
524fffdd288SMatthias Ringwald             gap_disconnect(handle);
525fffdd288SMatthias Ringwald             break;
526fffdd288SMatthias Ringwald         case 'u':
527fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
528fffdd288SMatthias Ringwald             printf("Join held call\n");
529fffdd288SMatthias Ringwald             hfp_ag_join_held_call();
530fffdd288SMatthias Ringwald             break;
531fffdd288SMatthias Ringwald         case 'v':
532fffdd288SMatthias Ringwald             start_scan();
533fffdd288SMatthias Ringwald             break;
534fffdd288SMatthias Ringwald         case 'w':
535fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
536fffdd288SMatthias Ringwald             printf("AG: Put incoming call on hold (Response and Hold)\n");
537fffdd288SMatthias Ringwald             hfp_ag_hold_incoming_call();
538fffdd288SMatthias Ringwald             break;
539fffdd288SMatthias Ringwald         case 'x':
540fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
541fffdd288SMatthias Ringwald             printf("AG: Accept held incoming call (Response and Hold)\n");
542fffdd288SMatthias Ringwald             hfp_ag_accept_held_incoming_call();
543fffdd288SMatthias Ringwald             break;
544fffdd288SMatthias Ringwald         case 'X':
545fffdd288SMatthias Ringwald             log_info("USER:\'%c\'", cmd);
546fffdd288SMatthias Ringwald             printf("AG: Reject held incoming call (Response and Hold)\n");
547fffdd288SMatthias Ringwald             hfp_ag_reject_held_incoming_call();
548fffdd288SMatthias Ringwald             break;
549fffdd288SMatthias Ringwald         default:
550fffdd288SMatthias Ringwald             show_usage();
551fffdd288SMatthias Ringwald             break;
552fffdd288SMatthias Ringwald     }
553fffdd288SMatthias Ringwald }
554fffdd288SMatthias Ringwald #endif
555fffdd288SMatthias Ringwald 
556fffdd288SMatthias Ringwald static void packet_handler(uint8_t * event, uint16_t event_size){
557fffdd288SMatthias Ringwald      switch (event[0]){
558fffdd288SMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT:
559fffdd288SMatthias Ringwald         case HCI_EVENT_INQUIRY_RESULT_WITH_RSSI:
560fffdd288SMatthias Ringwald         case HCI_EVENT_INQUIRY_COMPLETE:
561fffdd288SMatthias Ringwald         case HCI_EVENT_REMOTE_NAME_REQUEST_COMPLETE:
562fffdd288SMatthias Ringwald             inquiry_packet_handler(HCI_EVENT_PACKET, event, event_size);
563fffdd288SMatthias Ringwald             break;
564fffdd288SMatthias Ringwald 
565fffdd288SMatthias Ringwald         default:
566fffdd288SMatthias Ringwald             break;
567fffdd288SMatthias Ringwald     }
568fffdd288SMatthias Ringwald 
569fffdd288SMatthias Ringwald     if (event[0] != HCI_EVENT_HFP_META) return;
570fffdd288SMatthias Ringwald 
571fffdd288SMatthias Ringwald     if (event[3]
572fffdd288SMatthias Ringwald         && event[2] != HFP_SUBEVENT_PLACE_CALL_WITH_NUMBER
573fffdd288SMatthias Ringwald         && event[2] != HFP_SUBEVENT_ATTACH_NUMBER_TO_VOICE_TAG
574fffdd288SMatthias Ringwald         && event[2] != HFP_SUBEVENT_TRANSMIT_DTMF_CODES){
575fffdd288SMatthias Ringwald         printf("ERROR, status: %u\n", event[3]);
576fffdd288SMatthias Ringwald         return;
577fffdd288SMatthias Ringwald     }
578fffdd288SMatthias Ringwald 
579fffdd288SMatthias Ringwald     switch (event[2]) {
580fffdd288SMatthias Ringwald         case HFP_SUBEVENT_SERVICE_LEVEL_CONNECTION_ESTABLISHED:
581a0653c3bSMilanka Ringwald             handle = hfp_subevent_service_level_connection_established_get_con_handle(event);
582fffdd288SMatthias Ringwald             printf("Service level connection established.\n");
583fffdd288SMatthias Ringwald             break;
584fffdd288SMatthias Ringwald         case HFP_SUBEVENT_SERVICE_LEVEL_CONNECTION_RELEASED:
585fffdd288SMatthias Ringwald             printf("Service level connection released.\n");
586fffdd288SMatthias Ringwald             break;
587fffdd288SMatthias Ringwald         case HFP_SUBEVENT_AUDIO_CONNECTION_ESTABLISHED:
588fffdd288SMatthias Ringwald             printf("\n** Audio connection established **\n");
589fffdd288SMatthias Ringwald             break;
590fffdd288SMatthias Ringwald         case HFP_SUBEVENT_AUDIO_CONNECTION_RELEASED:
591fffdd288SMatthias Ringwald             printf("\n** Audio connection released **\n");
592fffdd288SMatthias Ringwald             break;
593fffdd288SMatthias Ringwald         case HFP_SUBEVENT_START_RINGINIG:
594fffdd288SMatthias Ringwald             printf("\n** Start Ringing **\n");
595fffdd288SMatthias Ringwald             break;
596fffdd288SMatthias Ringwald         case HFP_SUBEVENT_STOP_RINGINIG:
597fffdd288SMatthias Ringwald             printf("\n** Stop Ringing **\n");
598fffdd288SMatthias Ringwald             break;
599fffdd288SMatthias Ringwald         case HFP_SUBEVENT_PLACE_CALL_WITH_NUMBER:
6000696953aSMilanka Ringwald             printf("\n** Outgoing call '%s' **\n", hfp_subevent_place_call_with_number_get_number(event));
601fffdd288SMatthias Ringwald             // validate number
6020696953aSMilanka Ringwald             if ( strcmp("1234567", hfp_subevent_place_call_with_number_get_number(event)) == 0
6030696953aSMilanka Ringwald               || strcmp("7654321", hfp_subevent_place_call_with_number_get_number(event)) == 0
6040696953aSMilanka Ringwald               || (memory_1_enabled && strcmp(">1", hfp_subevent_place_call_with_number_get_number(event)) == 0)){
605fffdd288SMatthias Ringwald                 printf("Dialstring valid: accept call\n");
606fffdd288SMatthias Ringwald                 hfp_ag_outgoing_call_accepted();
607fffdd288SMatthias Ringwald             } else {
608fffdd288SMatthias Ringwald                 printf("Dialstring invalid: reject call\n");
609fffdd288SMatthias Ringwald                 hfp_ag_outgoing_call_rejected();
610fffdd288SMatthias Ringwald             }
611fffdd288SMatthias Ringwald             break;
612fffdd288SMatthias Ringwald 
613fffdd288SMatthias Ringwald         case HFP_SUBEVENT_ATTACH_NUMBER_TO_VOICE_TAG:
614fffdd288SMatthias Ringwald             printf("\n** Attach number to voice tag. Sending '1234567\n");
615fffdd288SMatthias Ringwald             hfp_ag_send_phone_number_for_voice_tag(device_addr, "1234567");
616fffdd288SMatthias Ringwald             break;
617fffdd288SMatthias Ringwald         case HFP_SUBEVENT_TRANSMIT_DTMF_CODES:
6180696953aSMilanka Ringwald             printf("\n** Send DTMF Codes: '%s'\n", hfp_subevent_transmit_dtmf_codes_get_dtmf(event));
619fffdd288SMatthias Ringwald             hfp_ag_send_dtmf_code_done(device_addr);
620fffdd288SMatthias Ringwald             break;
6210696953aSMilanka Ringwald         case HFP_SUBEVENT_CALL_ANSWERED:
622fffdd288SMatthias Ringwald             printf("Call answered by HF\n");
623fffdd288SMatthias Ringwald             break;
624fffdd288SMatthias Ringwald         default:
625fffdd288SMatthias Ringwald             printf("Event not handled %u\n", event[2]);
626fffdd288SMatthias Ringwald             break;
627fffdd288SMatthias Ringwald     }
628fffdd288SMatthias Ringwald }
629fffdd288SMatthias Ringwald 
630fffdd288SMatthias Ringwald static hfp_phone_number_t subscriber_number = {
631fffdd288SMatthias Ringwald     129, "225577"
632fffdd288SMatthias Ringwald };
633fffdd288SMatthias Ringwald 
634fffdd288SMatthias Ringwald /* @section Main Application Setup
635fffdd288SMatthias Ringwald  *
636fffdd288SMatthias Ringwald  * @text Listing MainConfiguration shows main application code.
637fffdd288SMatthias Ringwald  * To run a HFP AG service you need to initialize the SDP, and to create and register HFP AG record with it.
638fffdd288SMatthias Ringwald  * The packet_handler is used for sending commands to the HFP HF. It also receives the HFP HF's answers.
639fffdd288SMatthias Ringwald  * The stdin_process callback allows for sending commands to the HFP HF.
640fffdd288SMatthias Ringwald  * At the end the Bluetooth stack is started.
641fffdd288SMatthias Ringwald  */
642fffdd288SMatthias Ringwald 
643fffdd288SMatthias Ringwald /* LISTING_START(MainConfiguration): Setup HFP Audio Gateway */
644fffdd288SMatthias Ringwald 
645fffdd288SMatthias Ringwald int btstack_main(int argc, const char * argv[]);
646fffdd288SMatthias Ringwald int btstack_main(int argc, const char * argv[]){
647fffdd288SMatthias Ringwald 
648*e64e0086SMatthias Ringwald     gap_discoverable_control(1);
649*e64e0086SMatthias Ringwald 
650*e64e0086SMatthias Ringwald     // L2CAP
651*e64e0086SMatthias Ringwald     l2cap_init();
652*e64e0086SMatthias Ringwald 
653*e64e0086SMatthias Ringwald     // HFP
654*e64e0086SMatthias Ringwald     rfcomm_init();
655fffdd288SMatthias Ringwald     hfp_ag_init(rfcomm_channel_nr);
656fffdd288SMatthias Ringwald     hfp_ag_init_supported_features(0x3ef | (1<<HFP_AGSF_HF_INDICATORS) | (1<<HFP_AGSF_ESCO_S4));
657fffdd288SMatthias Ringwald     hfp_ag_init_codecs(sizeof(codecs), codecs);
658fffdd288SMatthias Ringwald     hfp_ag_init_ag_indicators(ag_indicators_nr, ag_indicators);
659fffdd288SMatthias Ringwald     hfp_ag_init_hf_indicators(hf_indicators_nr, hf_indicators);
660fffdd288SMatthias Ringwald     hfp_ag_init_call_hold_services(call_hold_services_nr, call_hold_services);
661fffdd288SMatthias Ringwald     hfp_ag_set_subcriber_number_information(&subscriber_number, 1);
662fffdd288SMatthias Ringwald     hfp_ag_register_packet_handler(packet_handler);
663fffdd288SMatthias Ringwald 
664*e64e0086SMatthias Ringwald     // SDP Server
665*e64e0086SMatthias Ringwald     sdp_init();
666fffdd288SMatthias Ringwald     memset(hfp_service_buffer, 0, sizeof(hfp_service_buffer));
667fffdd288SMatthias Ringwald     hfp_ag_create_sdp_record( hfp_service_buffer, 0x10001, rfcomm_channel_nr, hfp_ag_service_name, 0, 0);
668fffdd288SMatthias Ringwald     printf("SDP service record size: %u\n", de_get_len( hfp_service_buffer));
669fffdd288SMatthias Ringwald     sdp_register_service(hfp_service_buffer);
670fffdd288SMatthias Ringwald 
671d0755cd6SMatthias Ringwald #ifdef HAVE_POSIX_STDIN
672fffdd288SMatthias Ringwald     btstack_stdin_setup(stdin_process);
673fffdd288SMatthias Ringwald #endif
674fffdd288SMatthias Ringwald     // turn on!
675fffdd288SMatthias Ringwald     hci_power_control(HCI_POWER_ON);
676fffdd288SMatthias Ringwald     return 0;
677fffdd288SMatthias Ringwald }
678fffdd288SMatthias Ringwald /* LISTING_END */
6792b6b8c15SMilanka Ringwald /* EXAMPLE_END */
680