419 lines
14 KiB
C
419 lines
14 KiB
C
|
|
/*
|
|
This example code is in the Public Domain (or CC0 licensed, at your option.)
|
|
|
|
Unless required by applicable law or agreed to in writing, this
|
|
software is distributed on an "AS IS" BASIS, WITHOUT WARRANTIES OR
|
|
CONDITIONS OF ANY KIND, either express or implied.
|
|
*/
|
|
|
|
#include <stdint.h>
|
|
#include <stdbool.h>
|
|
#include <stdlib.h>
|
|
#include <string.h>
|
|
#include "esp_log.h"
|
|
|
|
#include "bt_app_core.h"
|
|
#include "bt_app_av.h"
|
|
#include "esp_bt_main.h"
|
|
#include "esp_bt_device.h"
|
|
#include "esp_gap_bt_api.h"
|
|
#include "esp_a2dp_api.h"
|
|
#include "esp_avrc_api.h"
|
|
|
|
#include "freertos/FreeRTOS.h"
|
|
#include "freertos/task.h"
|
|
#include "driver/i2s.h"
|
|
|
|
#include "sys/lock.h"
|
|
|
|
#include "H2201_i2s.h"
|
|
|
|
// AVRCP used transaction label
|
|
#define APP_RC_CT_TL_GET_CAPS (0)
|
|
#define APP_RC_CT_TL_GET_META_DATA (1)
|
|
#define APP_RC_CT_TL_RN_TRACK_CHANGE (2)
|
|
#define APP_RC_CT_TL_RN_PLAYBACK_CHANGE (3)
|
|
#define APP_RC_CT_TL_RN_PLAY_POS_CHANGE (4)
|
|
|
|
/* a2dp event handler */
|
|
static void h2201_a2dp_eventhandler(uint16_t event, void *p_param);
|
|
/* avrc CT event handler */
|
|
static void h2201_avrcp_CT_eventhandler(uint16_t event, void *p_param);
|
|
/* avrc TG event handler */
|
|
static void h2201_avrcp_TG_eventhandler(uint16_t event, void *p_param);
|
|
|
|
static uint32_t s_pkt_cnt = 0;
|
|
static esp_a2d_audio_state_t s_audio_state = ESP_A2D_AUDIO_STATE_STOPPED;
|
|
static const char *s_a2d_conn_state_str[] = {"Disconnected", "Connecting", "Connected", "Disconnecting"};
|
|
static const char *s_a2d_audio_state_str[] = {"Suspended", "Stopped", "Started"};
|
|
static esp_avrc_rn_evt_cap_mask_t s_avrc_peer_rn_cap;
|
|
static _lock_t s_volume_lock;
|
|
// static xTaskHandle s_vcs_task_hdl = NULL;
|
|
static uint8_t s_volume = 0;
|
|
static bool s_volume_notify;
|
|
|
|
/* callback for A2DP sink */
|
|
void h2201_a2dp_callback(esp_a2d_cb_event_t event, esp_a2d_cb_param_t *param)
|
|
{
|
|
switch (event)
|
|
{
|
|
case ESP_A2D_CONNECTION_STATE_EVT:
|
|
case ESP_A2D_AUDIO_STATE_EVT:
|
|
case ESP_A2D_AUDIO_CFG_EVT:
|
|
case ESP_A2D_PROF_STATE_EVT:
|
|
{
|
|
bt_app_work_dispatch(h2201_a2dp_eventhandler, event, param, sizeof(esp_a2d_cb_param_t), NULL);
|
|
break;
|
|
}
|
|
default:
|
|
ESP_LOGE(BT_AV_TAG, "Invalid A2DP event: %d", event);
|
|
break;
|
|
}
|
|
}
|
|
|
|
void h2201_a2dp_data_callback(const uint8_t *data, uint32_t len)
|
|
{
|
|
h2201_i2s_write_ringbuf(data, len);
|
|
// if (++s_pkt_cnt % 100 == 0) {
|
|
// ESP_LOGI(BT_AV_TAG, "Audio packet count %u", s_pkt_cnt);
|
|
// }
|
|
}
|
|
|
|
void bt_app_alloc_meta_buffer(esp_avrc_ct_cb_param_t *param)
|
|
{
|
|
esp_avrc_ct_cb_param_t *rc = (esp_avrc_ct_cb_param_t *)(param);
|
|
uint8_t *attr_text = (uint8_t *)malloc(rc->meta_rsp.attr_length + 1);
|
|
memcpy(attr_text, rc->meta_rsp.attr_text, rc->meta_rsp.attr_length);
|
|
attr_text[rc->meta_rsp.attr_length] = 0;
|
|
|
|
rc->meta_rsp.attr_text = attr_text;
|
|
}
|
|
|
|
void h2201_avrcp_CT_callback(esp_avrc_ct_cb_event_t event, esp_avrc_ct_cb_param_t *param)
|
|
{
|
|
switch (event)
|
|
{
|
|
case ESP_AVRC_CT_METADATA_RSP_EVT:
|
|
bt_app_alloc_meta_buffer(param);
|
|
/* fall through */
|
|
case ESP_AVRC_CT_CONNECTION_STATE_EVT:
|
|
case ESP_AVRC_CT_PASSTHROUGH_RSP_EVT:
|
|
case ESP_AVRC_CT_CHANGE_NOTIFY_EVT:
|
|
case ESP_AVRC_CT_REMOTE_FEATURES_EVT:
|
|
case ESP_AVRC_CT_GET_RN_CAPABILITIES_RSP_EVT:
|
|
{
|
|
bt_app_work_dispatch(h2201_avrcp_CT_eventhandler, event, param, sizeof(esp_avrc_ct_cb_param_t), NULL);
|
|
break;
|
|
}
|
|
default:
|
|
ESP_LOGE(BT_RC_CT_TAG, "Invalid AVRC event: %d", event);
|
|
break;
|
|
}
|
|
}
|
|
|
|
void h2201_avrcp_TG_callback(esp_avrc_tg_cb_event_t event, esp_avrc_tg_cb_param_t *param)
|
|
{
|
|
switch (event)
|
|
{
|
|
case ESP_AVRC_TG_CONNECTION_STATE_EVT:
|
|
case ESP_AVRC_TG_REMOTE_FEATURES_EVT:
|
|
case ESP_AVRC_TG_PASSTHROUGH_CMD_EVT:
|
|
case ESP_AVRC_TG_SET_ABSOLUTE_VOLUME_CMD_EVT:
|
|
case ESP_AVRC_TG_REGISTER_NOTIFICATION_EVT:
|
|
case ESP_AVRC_TG_SET_PLAYER_APP_VALUE_EVT:
|
|
bt_app_work_dispatch(h2201_avrcp_TG_eventhandler, event, param, sizeof(esp_avrc_tg_cb_param_t), NULL);
|
|
break;
|
|
default:
|
|
ESP_LOGE(BT_RC_TG_TAG, "Invalid AVRC event: %d", event);
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void h2201_a2dp_eventhandler(uint16_t event, void *p_param)
|
|
{
|
|
ESP_LOGD(BT_AV_TAG, "%s evt %d", __func__, event);
|
|
esp_a2d_cb_param_t *a2d = NULL;
|
|
switch (event)
|
|
{
|
|
case ESP_A2D_CONNECTION_STATE_EVT:
|
|
{
|
|
a2d = (esp_a2d_cb_param_t *)(p_param);
|
|
uint8_t *bda = a2d->conn_stat.remote_bda;
|
|
ESP_LOGI(BT_AV_TAG, "A2DP connection state: %s, [%02x:%02x:%02x:%02x:%02x:%02x]",
|
|
s_a2d_conn_state_str[a2d->conn_stat.state], bda[0], bda[1], bda[2], bda[3], bda[4], bda[5]);
|
|
if (a2d->conn_stat.state == ESP_A2D_CONNECTION_STATE_DISCONNECTED)
|
|
{
|
|
esp_bt_gap_set_scan_mode(ESP_BT_CONNECTABLE, ESP_BT_GENERAL_DISCOVERABLE);
|
|
h2201_i2s_task_shut_down();
|
|
}
|
|
else if (a2d->conn_stat.state == ESP_A2D_CONNECTION_STATE_CONNECTED)
|
|
{
|
|
esp_bt_gap_set_scan_mode(ESP_BT_NON_CONNECTABLE, ESP_BT_NON_DISCOVERABLE);
|
|
h2201_i2s_task_start_up();
|
|
}
|
|
break;
|
|
}
|
|
case ESP_A2D_AUDIO_STATE_EVT:
|
|
{
|
|
a2d = (esp_a2d_cb_param_t *)(p_param);
|
|
ESP_LOGI(BT_AV_TAG, "A2DP audio state: %s", s_a2d_audio_state_str[a2d->audio_stat.state]);
|
|
s_audio_state = a2d->audio_stat.state;
|
|
if (ESP_A2D_AUDIO_STATE_STARTED == a2d->audio_stat.state)
|
|
{
|
|
s_pkt_cnt = 0;
|
|
}
|
|
break;
|
|
}
|
|
case ESP_A2D_AUDIO_CFG_EVT:
|
|
{
|
|
a2d = (esp_a2d_cb_param_t *)(p_param);
|
|
ESP_LOGI(BT_AV_TAG, "A2DP audio stream configuration, codec type %d", a2d->audio_cfg.mcc.type);
|
|
// for now only SBC stream is supported
|
|
if (a2d->audio_cfg.mcc.type == ESP_A2D_MCT_SBC)
|
|
{
|
|
int sample_rate = 16000;
|
|
char oct0 = a2d->audio_cfg.mcc.cie.sbc[0];
|
|
if (oct0 & (0x01 << 6))
|
|
{
|
|
sample_rate = 32000;
|
|
}
|
|
else if (oct0 & (0x01 << 5))
|
|
{
|
|
sample_rate = 44100;
|
|
}
|
|
else if (oct0 & (0x01 << 4))
|
|
{
|
|
sample_rate = 48000;
|
|
}
|
|
i2s_set_clk(0, sample_rate, 16, 2);
|
|
|
|
ESP_LOGI(BT_AV_TAG, "Configure audio player %x-%x-%x-%x",
|
|
a2d->audio_cfg.mcc.cie.sbc[0],
|
|
a2d->audio_cfg.mcc.cie.sbc[1],
|
|
a2d->audio_cfg.mcc.cie.sbc[2],
|
|
a2d->audio_cfg.mcc.cie.sbc[3]);
|
|
ESP_LOGI(BT_AV_TAG, "Audio player configured, sample rate=%d", sample_rate);
|
|
}
|
|
break;
|
|
}
|
|
case ESP_A2D_PROF_STATE_EVT:
|
|
{
|
|
a2d = (esp_a2d_cb_param_t *)(p_param);
|
|
if (ESP_A2D_INIT_SUCCESS == a2d->a2d_prof_stat.init_state)
|
|
{
|
|
ESP_LOGI(BT_AV_TAG, "A2DP PROF STATE: Init Compl\n");
|
|
}
|
|
else
|
|
{
|
|
ESP_LOGI(BT_AV_TAG, "A2DP PROF STATE: Deinit Compl\n");
|
|
}
|
|
break;
|
|
}
|
|
default:
|
|
ESP_LOGE(BT_AV_TAG, "%s unhandled evt %d", __func__, event);
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void h2201_avrcp_new_track(void)
|
|
{
|
|
// request metadata
|
|
uint8_t attr_mask = ESP_AVRC_MD_ATTR_TITLE | ESP_AVRC_MD_ATTR_ARTIST | ESP_AVRC_MD_ATTR_ALBUM | ESP_AVRC_MD_ATTR_GENRE;
|
|
esp_avrc_ct_send_metadata_cmd(APP_RC_CT_TL_GET_META_DATA, attr_mask);
|
|
|
|
// register notification if peer support the event_id
|
|
if (esp_avrc_rn_evt_bit_mask_operation(ESP_AVRC_BIT_MASK_OP_TEST, &s_avrc_peer_rn_cap, ESP_AVRC_RN_TRACK_CHANGE))
|
|
{
|
|
esp_avrc_ct_send_register_notification_cmd(APP_RC_CT_TL_RN_TRACK_CHANGE, ESP_AVRC_RN_TRACK_CHANGE, 0);
|
|
}
|
|
}
|
|
|
|
static void h2201_avrcp_playback_changed(void)
|
|
{
|
|
if (esp_avrc_rn_evt_bit_mask_operation(ESP_AVRC_BIT_MASK_OP_TEST, &s_avrc_peer_rn_cap, ESP_AVRC_RN_PLAY_STATUS_CHANGE))
|
|
{
|
|
esp_avrc_ct_send_register_notification_cmd(APP_RC_CT_TL_RN_PLAYBACK_CHANGE, ESP_AVRC_RN_PLAY_STATUS_CHANGE, 0);
|
|
}
|
|
}
|
|
|
|
static void h2201_avrcp_play_position_changed(void)
|
|
{
|
|
if (esp_avrc_rn_evt_bit_mask_operation(ESP_AVRC_BIT_MASK_OP_TEST, &s_avrc_peer_rn_cap, ESP_AVRC_RN_PLAY_POS_CHANGED))
|
|
{
|
|
esp_avrc_ct_send_register_notification_cmd(APP_RC_CT_TL_RN_PLAY_POS_CHANGE, ESP_AVRC_RN_PLAY_POS_CHANGED, 10);
|
|
}
|
|
}
|
|
|
|
void h2201_avrcp_notify_eventhandler(uint8_t event_id, esp_avrc_rn_param_t *event_parameter)
|
|
{
|
|
switch (event_id)
|
|
{
|
|
case ESP_AVRC_RN_TRACK_CHANGE:
|
|
h2201_avrcp_new_track();
|
|
break;
|
|
case ESP_AVRC_RN_PLAY_STATUS_CHANGE:
|
|
ESP_LOGI(BT_AV_TAG, "Playback status changed: 0x%x", event_parameter->playback);
|
|
h2201_avrcp_playback_changed();
|
|
break;
|
|
case ESP_AVRC_RN_PLAY_POS_CHANGED:
|
|
ESP_LOGI(BT_AV_TAG, "Play position changed: %d-ms", event_parameter->play_pos);
|
|
h2201_avrcp_play_position_changed();
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void h2201_avrcp_CT_eventhandler(uint16_t event, void *p_param)
|
|
{
|
|
ESP_LOGD(BT_RC_CT_TAG, "%s evt %d", __func__, event);
|
|
esp_avrc_ct_cb_param_t *rc = (esp_avrc_ct_cb_param_t *)(p_param);
|
|
switch (event)
|
|
{
|
|
case ESP_AVRC_CT_CONNECTION_STATE_EVT:
|
|
{
|
|
uint8_t *bda = rc->conn_stat.remote_bda;
|
|
ESP_LOGI(BT_RC_CT_TAG, "AVRC conn_state evt: state %d, [%02x:%02x:%02x:%02x:%02x:%02x]",
|
|
rc->conn_stat.connected, bda[0], bda[1], bda[2], bda[3], bda[4], bda[5]);
|
|
|
|
if (rc->conn_stat.connected)
|
|
{
|
|
// get remote supported event_ids of peer AVRCP Target
|
|
esp_avrc_ct_send_get_rn_capabilities_cmd(APP_RC_CT_TL_GET_CAPS);
|
|
}
|
|
else
|
|
{
|
|
// clear peer notification capability record
|
|
s_avrc_peer_rn_cap.bits = 0;
|
|
}
|
|
break;
|
|
}
|
|
case ESP_AVRC_CT_PASSTHROUGH_RSP_EVT:
|
|
{
|
|
ESP_LOGI(BT_RC_CT_TAG, "AVRC passthrough rsp: key_code 0x%x, key_state %d", rc->psth_rsp.key_code, rc->psth_rsp.key_state);
|
|
break;
|
|
}
|
|
case ESP_AVRC_CT_METADATA_RSP_EVT:
|
|
{
|
|
ESP_LOGI(BT_RC_CT_TAG, "AVRC metadata rsp: attribute id 0x%x, %s", rc->meta_rsp.attr_id, rc->meta_rsp.attr_text);
|
|
free(rc->meta_rsp.attr_text);
|
|
break;
|
|
}
|
|
case ESP_AVRC_CT_CHANGE_NOTIFY_EVT:
|
|
{
|
|
ESP_LOGI(BT_RC_CT_TAG, "AVRC event notification: %d", rc->change_ntf.event_id);
|
|
h2201_avrcp_notify_eventhandler(rc->change_ntf.event_id, &rc->change_ntf.event_parameter);
|
|
break;
|
|
}
|
|
case ESP_AVRC_CT_REMOTE_FEATURES_EVT:
|
|
{
|
|
ESP_LOGI(BT_RC_CT_TAG, "AVRC remote features %x, TG features %x", rc->rmt_feats.feat_mask, rc->rmt_feats.tg_feat_flag);
|
|
break;
|
|
}
|
|
case ESP_AVRC_CT_GET_RN_CAPABILITIES_RSP_EVT:
|
|
{
|
|
ESP_LOGI(BT_RC_CT_TAG, "remote rn_cap: count %d, bitmask 0x%x", rc->get_rn_caps_rsp.cap_count,
|
|
rc->get_rn_caps_rsp.evt_set.bits);
|
|
s_avrc_peer_rn_cap.bits = rc->get_rn_caps_rsp.evt_set.bits;
|
|
h2201_avrcp_new_track();
|
|
h2201_avrcp_playback_changed();
|
|
h2201_avrcp_play_position_changed();
|
|
break;
|
|
}
|
|
default:
|
|
ESP_LOGE(BT_RC_CT_TAG, "%s unhandled evt %d", __func__, event);
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void volume_set_by_controller(uint8_t volume)
|
|
{
|
|
ESP_LOGI(BT_RC_TG_TAG, "Volume is set by remote controller %d%%\n", (uint32_t)volume * 100 / 0x7f);
|
|
_lock_acquire(&s_volume_lock);
|
|
s_volume = volume;
|
|
_lock_release(&s_volume_lock);
|
|
}
|
|
|
|
// static void volume_set_by_local_host(uint8_t volume)
|
|
// {
|
|
// ESP_LOGI(BT_RC_TG_TAG, "Volume is set locally to: %d%%", (uint32_t)volume * 100 / 0x7f);
|
|
// _lock_acquire(&s_volume_lock);
|
|
// s_volume = volume;
|
|
// _lock_release(&s_volume_lock);
|
|
|
|
// if (s_volume_notify) {
|
|
// esp_avrc_rn_param_t rn_param;
|
|
// rn_param.volume = s_volume;
|
|
// esp_avrc_tg_send_rn_rsp(ESP_AVRC_RN_VOLUME_CHANGE, ESP_AVRC_RN_RSP_CHANGED, &rn_param);
|
|
// s_volume_notify = false;
|
|
// }
|
|
// }
|
|
|
|
// static void volume_change_simulation(void *arg)
|
|
// {
|
|
// ESP_LOGI(BT_RC_TG_TAG, "start volume change simulation");
|
|
|
|
// for (;;) {
|
|
// vTaskDelay(10000 / portTICK_RATE_MS);
|
|
|
|
// uint8_t volume = (s_volume + 5) & 0x7f;
|
|
// volume_set_by_local_host(volume);
|
|
// }
|
|
// }
|
|
|
|
static void h2201_avrcp_TG_eventhandler(uint16_t event, void *p_param)
|
|
{
|
|
ESP_LOGD(BT_RC_TG_TAG, "%s evt %d", __func__, event);
|
|
esp_avrc_tg_cb_param_t *rc = (esp_avrc_tg_cb_param_t *)(p_param);
|
|
switch (event)
|
|
{
|
|
case ESP_AVRC_TG_CONNECTION_STATE_EVT:
|
|
{
|
|
uint8_t *bda = rc->conn_stat.remote_bda;
|
|
ESP_LOGI(BT_RC_TG_TAG, "AVRC conn_state evt: state %d, [%02x:%02x:%02x:%02x:%02x:%02x]",
|
|
rc->conn_stat.connected, bda[0], bda[1], bda[2], bda[3], bda[4], bda[5]);
|
|
if (rc->conn_stat.connected)
|
|
{
|
|
// create task to simulate volume change
|
|
// xTaskCreate(volume_change_simulation, "vcsT", 2048, NULL, 5, &s_vcs_task_hdl);
|
|
}
|
|
else
|
|
{
|
|
// vTaskDelete(s_vcs_task_hdl);
|
|
// ESP_LOGI(BT_RC_TG_TAG, "Stop volume change simulation");
|
|
}
|
|
break;
|
|
}
|
|
case ESP_AVRC_TG_PASSTHROUGH_CMD_EVT:
|
|
{
|
|
ESP_LOGI(BT_RC_TG_TAG, "AVRC passthrough cmd: key_code 0x%x, key_state %d", rc->psth_cmd.key_code, rc->psth_cmd.key_state);
|
|
break;
|
|
}
|
|
case ESP_AVRC_TG_SET_ABSOLUTE_VOLUME_CMD_EVT:
|
|
{
|
|
ESP_LOGI(BT_RC_TG_TAG, "AVRC set absolute volume: %d%%", (int)rc->set_abs_vol.volume * 100 / 0x7f);
|
|
volume_set_by_controller(rc->set_abs_vol.volume);
|
|
break;
|
|
}
|
|
case ESP_AVRC_TG_REGISTER_NOTIFICATION_EVT:
|
|
{
|
|
ESP_LOGI(BT_RC_TG_TAG, "AVRC register event notification: %d, param: 0x%x", rc->reg_ntf.event_id, rc->reg_ntf.event_parameter);
|
|
if (rc->reg_ntf.event_id == ESP_AVRC_RN_VOLUME_CHANGE)
|
|
{
|
|
s_volume_notify = true;
|
|
esp_avrc_rn_param_t rn_param;
|
|
rn_param.volume = s_volume;
|
|
esp_avrc_tg_send_rn_rsp(ESP_AVRC_RN_VOLUME_CHANGE, ESP_AVRC_RN_RSP_INTERIM, &rn_param);
|
|
}
|
|
break;
|
|
}
|
|
case ESP_AVRC_TG_REMOTE_FEATURES_EVT:
|
|
{
|
|
ESP_LOGI(BT_RC_TG_TAG, "AVRC remote features %x, CT features %x", rc->rmt_feats.feat_mask, rc->rmt_feats.ct_feat_flag);
|
|
break;
|
|
}
|
|
default:
|
|
ESP_LOGE(BT_RC_TG_TAG, "%s unhandled evt %d", __func__, event);
|
|
break;
|
|
}
|
|
}
|