mirror of
https://github.com/bluekitchen/btstack.git
synced 2024-12-28 15:20:39 +00:00
336 lines
13 KiB
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 */
|