btstack/example/hsp_ag_demo.c

336 lines
13 KiB
C

/*
* Copyright (C) 2014 BlueKitchen GmbH
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
*
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. Neither the name of the copyright holders nor the names of
* contributors may be used to endorse or promote products derived
* from this software without specific prior written permission.
* 4. Any redistribution, use, or modification is done solely for
* personal benefit and not for any commercial purpose or for
* monetary gain.
*
* THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL BLUEKITCHEN
* GMBH OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
* THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
* Please inquire about commercial licensing options at
* contact@bluekitchen-gmbh.com
*
*/
#define BTSTACK_FILE__ "hsp_ag_demo.c"
/*
* hsp_ag_demo.c
*/
// *****************************************************************************
/* EXAMPLE_START(hsp_ag_demo): HSP AG - Audio Gateway
*
* @text This example implements a HSP Audio Gateway device that sends and receives
* audio signal over HCI SCO. It demonstrates how to receive
* an output from a remote headset (HS), and,
* if HAVE_BTSTACK_STDIN is defined, how to control the HS.
*/
// *****************************************************************************
#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include "btstack.h"
#include "sco_demo_util.h"
#ifdef HAVE_BTSTACK_STDIN
#include "btstack_stdin.h"
#endif
static uint8_t hsp_service_buffer[150];
static const uint8_t rfcomm_channel_nr = 1;
static const char hsp_ag_service_name[] = "Audio Gateway Test";
static uint16_t sco_handle = HCI_CON_HANDLE_INVALID;
static char hs_cmd_buffer[100];
static const char * device_name = "HSP AG Demo 00:00:00:00:00:00";
static const char * device_addr_string = "00:1b:dc:07:32:ef";
static bd_addr_t device_addr;
/* @section Audio Transfer Setup
*
* @text A pre-computed sine wave (160Hz) is used as the input audio signal. 160 Hz.
* To send and receive an audio signal, ENABLE_SCO_OVER_HCI has to be defined.
*
* Tested working setups:
* - Ubuntu 14 64-bit, CC2564B connected via FTDI USB-2-UART adapter, 921600 baud
* - Ubuntu 14 64-bit, CSR USB dongle
* - OS X 10.11, CSR USB dongle
*
* Broken setups:
* - OS X 10.11, CC2564B connected via FDTI USB-2-UART adapter, 921600 baud
* - select(..) blocks > 400 ms -> num completed is received to late -> gaps between audio
* - looks like bug in select->FTDI driver as it works correct on Linux
*
* SCO not routed over HCI yet:
* - CSR UART dongle
* - Broadcom USB dongle
* - Broadcom UART chipset
* - ..
*
*/
#ifdef HAVE_BTSTACK_STDIN
static void show_usage(void){
bd_addr_t iut_address;
gap_local_bd_addr(iut_address);
printf("\n--- Bluetooth HSP Audio Gateway Test Console %s ---\n", bd_addr_to_str(iut_address));
printf("---\n");
printf("c - Connect to %s\n", device_addr_string);
printf("C - Disconnect\n");
printf("a - establish audio connection\n");
printf("A - release audio connection\n");
printf("D - delete all link keys\n");
printf("m - set microphone gain 8\n");
printf("M - set microphone gain 15\n");
printf("o - set speaker gain 0\n");
printf("s - set speaker gain 8\n");
printf("S - set speaker gain 15\n");
printf("r - start ringing\n");
printf("t - stop ringing\n");
printf("\n");
}
static void stdin_process(char c){
switch (c){
case 'a':
printf("Establish audio connection\n");
hsp_ag_establish_audio_connection();
break;
case 'A':
printf("Release audio connection\n");
hsp_ag_release_audio_connection();
break;
case 'c':
printf("Connect to %s\n", device_addr_string);
hsp_ag_connect(device_addr);
break;
case 'C':
printf("Disconnect.\n");
hsp_ag_disconnect();
break;
case 'D':
printf("Deleting all link keys\n");
gap_delete_all_link_keys();
break;
case 'm':
printf("Setting microphone gain 8\n");
hsp_ag_set_microphone_gain(8);
break;
case 'M':
printf("Setting microphone gain 15\n");
hsp_ag_set_microphone_gain(15);
break;
case 'o':
printf("Setting speaker gain 0\n");
hsp_ag_set_speaker_gain(0);
break;
case 's':
printf("Setting speaker gain 8\n");
hsp_ag_set_speaker_gain(8);
break;
case 'S':
printf("Setting speaker gain 15\n");
hsp_ag_set_speaker_gain(15);
break;
case 'r':
printf("Start ringing\n");
hsp_ag_start_ringing();
break;
case 't':
printf("Stop ringing\n");
hsp_ag_stop_ringing();
break;
default:
show_usage();
break;
}
}
#endif
static void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t * event, uint16_t event_size){
UNUSED(channel);
uint8_t status;
switch (packet_type){
case HCI_SCO_DATA_PACKET:
if (READ_SCO_CONNECTION_HANDLE(event) != sco_handle) break;
sco_demo_receive(event, event_size);
break;
case HCI_EVENT_PACKET:
switch (hci_event_packet_get_type(event)) {
#ifndef HAVE_BTSTACK_STDIN
case BTSTACK_EVENT_STATE:
if (btstack_event_state_get_state(event) != HCI_STATE_WORKING) break;
printf("Establish HSP AG service to %s...\n", device_addr_string);
hsp_ag_connect(device_addr);
break;
#endif
case HCI_EVENT_SCO_CAN_SEND_NOW:
sco_demo_send(sco_handle);
break;
case HCI_EVENT_HSP_META:
switch (hci_event_hsp_meta_get_subevent_code(event)) {
case HSP_SUBEVENT_RFCOMM_CONNECTION_COMPLETE:
status = hsp_subevent_rfcomm_connection_complete_get_status(event);
if (status != ERROR_CODE_SUCCESS){
printf("RFCOMM connection establishement failed, status 0x%02x\n", status);
break;
}
printf("RFCOMM connection established.\n");
#ifndef HAVE_BTSTACK_STDIN
printf("Establish Audio connection to %s...\n", device_addr_string);
hsp_ag_establish_audio_connection();
#endif
break;
case HSP_SUBEVENT_RFCOMM_DISCONNECTION_COMPLETE:
printf("RFCOMM disconnected.\n");
break;
case HSP_SUBEVENT_AUDIO_CONNECTION_COMPLETE:
status = hsp_subevent_audio_connection_complete_get_status(event);
if (status != ERROR_CODE_SUCCESS){
printf("Audio connection establishment failed, status 0x%02x\n", status);
} else {
sco_handle = hsp_subevent_audio_connection_complete_get_sco_handle(event);
printf("Audio connection established with SCO handle 0x%04x.\n", sco_handle);
hci_request_sco_can_send_now_event();
}
break;
case HSP_SUBEVENT_AUDIO_DISCONNECTION_COMPLETE:
printf("Audio connection released.\n\n");
sco_handle = HCI_CON_HANDLE_INVALID;
break;
case HSP_SUBEVENT_MICROPHONE_GAIN_CHANGED:
printf("Received microphone gain change %d\n", hsp_subevent_microphone_gain_changed_get_gain(event));
break;
case HSP_SUBEVENT_SPEAKER_GAIN_CHANGED:
printf("Received speaker gain change %d\n", hsp_subevent_speaker_gain_changed_get_gain(event));
break;
case HSP_SUBEVENT_HS_COMMAND:{
memset(hs_cmd_buffer, 0, sizeof(hs_cmd_buffer));
unsigned int cmd_length = hsp_subevent_hs_command_get_value_length(event);
unsigned int size = cmd_length <= sizeof(hs_cmd_buffer)? cmd_length : sizeof(hs_cmd_buffer);
memcpy(hs_cmd_buffer, hsp_subevent_hs_command_get_value(event), size - 1);
printf("Received custom command: \"%s\". \nExit code or call hsp_ag_send_result.\n", hs_cmd_buffer);
break;
}
case HSP_SUBEVENT_BUTTON_PRESSED:
if (sco_handle == HCI_CON_HANDLE_INVALID){
printf("Button event -> establish audio\n");
hsp_ag_establish_audio_connection();
} else {
printf("Button event -> release audio\n");
hsp_ag_release_audio_connection();
}
break;
default:
printf("event not handled 0x%02x\n", event[2]);
break;
}
break;
default:
break;
}
break;
default:
break;
}
}
/* @section Main Application Setup
*
* @text Listing MainConfiguration shows main application code.
* To run a HSP Audio Gateway service you need to initialize the SDP, and to create and register HSP AG record with it.
* In this example, the SCO over HCI is used to receive and send an audio signal.
*
* Two packet handlers are registered:
* - The HCI SCO packet handler receives audio data.
* - The HSP AG packet handler is used to trigger sending of audio data and commands to the HS. It also receives the AG's answers.
*
* The stdin_process callback allows for sending commands to the AG.
* At the end the Bluetooth stack is started.
*/
/* LISTING_START(MainConfiguration): Setup HSP Audio Gateway */
int btstack_main(int argc, const char * argv[]);
int btstack_main(int argc, const char * argv[]){
(void)argc;
(void)argv;
sco_demo_init();
sco_demo_set_codec(HFP_CODEC_CVSD);
l2cap_init();
#ifdef ENABLE_BLE
// Initialize LE Security Manager. Needed for cross-transport key derivation
sm_init();
#endif
sdp_init();
memset((uint8_t *)hsp_service_buffer, 0, sizeof(hsp_service_buffer));
hsp_ag_create_sdp_record(hsp_service_buffer, sdp_create_service_record_handle(), rfcomm_channel_nr, hsp_ag_service_name);
btstack_assert(de_get_len( hsp_service_buffer) <= sizeof(hsp_service_buffer));
sdp_register_service(hsp_service_buffer);
rfcomm_init();
hsp_ag_init(rfcomm_channel_nr);
hsp_ag_register_packet_handler(&packet_handler);
// register for SCO packets
hci_register_sco_packet_handler(&packet_handler);
// parse human readable Bluetooth address
sscanf_bd_addr(device_addr_string, device_addr);
#ifdef HAVE_BTSTACK_STDIN
btstack_stdin_setup(stdin_process);
#endif
gap_set_local_name(device_name);
gap_discoverable_control(1);
gap_ssp_set_io_capability(SSP_IO_CAPABILITY_DISPLAY_YES_NO);
gap_set_class_of_device(0x400204);
// turn on!
hci_power_control(HCI_POWER_ON);
return 0;
}
/* LISTING_END */
/* EXAMPLE_END */