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