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