mirror/btstack
1
0
Fork 0
mirror of https://github.com/bluekitchen/btstack.git synced 2025-01-31 00:32:52 +00:00
Code Issues Packages Projects Releases Wiki Activity

avdtp_util: extract media codec config event setup code

Browse Source
This commit is contained in:
Matthias Ringwald 2021-07-16 10:45:28 +02:00
parent 43e99aeee1
commit 186e197033
1 changed files with 92 additions and 62 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

154
src/classic/avdtp_util.c
View File

@ -47,7 +47,7 @@
#include "btstack_util.h"
#include "l2cap.h"
#define MAX_MEDIA_CODEC_INFORMATION_LENGTH 100
#define MAX_MEDIA_CODEC_INFORMATION_LENGTH 30
/*
@ -915,18 +915,22 @@ void avdtp_signaling_emit_capabilities(uint16_t avdtp_cid, uint8_t remote_seid,
avdtp_signaling_emit_capability_done(avdtp_cid, remote_seid);
}
static void
avdtp_signaling_emit_media_codec_sbc(avdtp_stream_endpoint_t *stream_endpoint, uint16_t avdtp_cid, uint8_t reconfigure,
avdtp_media_type_t media_type, const uint8_t *media_codec_information) {
#define MEDIA_CONFIG_SBC_EVENT_LEN 18
static uint16_t
avdtp_signaling_setup_media_codec_sbc_config_event(uint8_t *event, uint16_t size,
avdtp_stream_endpoint_t *stream_endpoint,
uint16_t avdtp_cid, uint8_t reconfigure,
const uint8_t *media_codec_information) {
btstack_assert(size >= MEDIA_CONFIG_SBC_EVENT_LEN);
btstack_packet_handler_t packet_handler = avdtp_packet_handler_for_stream_endpoint(stream_endpoint);
uint8_t local_seid = avdtp_local_seid(stream_endpoint);
uint8_t remote_seid = avdtp_remote_seid(stream_endpoint);
uint8_t event[16 + 2];
int pos = 0;
event[pos++] = HCI_EVENT_AVDTP_META;
event[pos++] = sizeof(event) - 2;
event[pos++] = MEDIA_CONFIG_SBC_EVENT_LEN - 2;
event[pos++] = AVDTP_SUBEVENT_SIGNALING_MEDIA_CODEC_SBC_CONFIGURATION;
little_endian_store_16(event, pos, avdtp_cid);
@ -934,7 +938,7 @@ avdtp_signaling_emit_media_codec_sbc(avdtp_stream_endpoint_t *stream_endpoint, u
event[pos++] = local_seid;
event[pos++] = remote_seid;
event[pos++] = reconfigure;
event[pos++] = AVDTP_CODEC_SBC;
uint8_t sampling_frequency_bitmap = media_codec_information[0] >> 4;
uint8_t channel_mode_bitmap = media_codec_information[0] & 0x0F;
@ -987,7 +991,6 @@ avdtp_signaling_emit_media_codec_sbc(avdtp_stream_endpoint_t *stream_endpoint, u
block_length = 4;
}
event[pos++] = media_type;
little_endian_store_16(event, pos, sampling_frequency);
pos += 2;
@ -998,22 +1001,28 @@ avdtp_signaling_emit_media_codec_sbc(avdtp_stream_endpoint_t *stream_endpoint, u
event[pos++] = media_codec_information[1] & 0x03;
event[pos++] = media_codec_information[2];
event[pos++] = media_codec_information[3];
(*packet_handler)(HCI_EVENT_PACKET, 0, event, pos);
btstack_assert(pos == MEDIA_CONFIG_SBC_EVENT_LEN);
return pos;
}
static void
avdtp_signaling_emit_media_codec_mpeg_audio_configuration(avdtp_stream_endpoint_t *stream_endpoint, uint16_t avdtp_cid,
uint8_t reconfigure, avdtp_media_type_t media_type,
#define MEDIA_CONFIG_MPEG_AUDIO_EVENT_LEN 18
static uint16_t
avdtp_signaling_setup_media_codec_mpeg_audio_config_event(uint8_t *event, uint16_t size,
avdtp_stream_endpoint_t *stream_endpoint,
uint16_t avdtp_cid, uint8_t reconfigure,
const uint8_t *media_codec_information) {
btstack_packet_handler_t packet_handler = avdtp_packet_handler_for_stream_endpoint(stream_endpoint);
btstack_assert(size >= MEDIA_CONFIG_MPEG_AUDIO_EVENT_LEN);
uint8_t local_seid = avdtp_local_seid(stream_endpoint);
uint8_t remote_seid = avdtp_remote_seid(stream_endpoint);
uint8_t event[18];
int pos = 0;
uint16_t pos = 0;
event[pos++] = HCI_EVENT_AVDTP_META;
event[pos++] = sizeof(event) - 2;
event[pos++] = MEDIA_CONFIG_MPEG_AUDIO_EVENT_LEN - 2;
event[pos++] = AVDTP_SUBEVENT_SIGNALING_MEDIA_CODEC_MPEG_AUDIO_CONFIGURATION;
little_endian_store_16(event, pos, avdtp_cid);
@ -1021,6 +1030,7 @@ avdtp_signaling_emit_media_codec_mpeg_audio_configuration(avdtp_stream_endpoint_
event[pos++] = local_seid;
event[pos++] = remote_seid;
event[pos++] = reconfigure;
event[pos++] = AVDTP_CODEC_MPEG_1_2_AUDIO;
uint8_t layer_bitmap = media_codec_information[0] >> 5;
uint8_t crc = (media_codec_information[0] >> 4) & 0x01;
@ -1078,7 +1088,6 @@ avdtp_signaling_emit_media_codec_mpeg_audio_configuration(avdtp_stream_endpoint_
}
}
event[pos++] = media_type;
event[pos++] = (uint8_t) layer;
event[pos++] = crc;
event[pos++] = (uint8_t) channel_mode;
@ -1089,23 +1098,27 @@ avdtp_signaling_emit_media_codec_mpeg_audio_configuration(avdtp_stream_endpoint_
event[pos++] = vbr;
event[pos++] = bitrate_index;
(*packet_handler)(HCI_EVENT_PACKET, 0, event, pos);
btstack_assert(pos == MEDIA_CONFIG_MPEG_AUDIO_EVENT_LEN);
return pos;
}
#define MEDIA_CONFIG_MPEG_AAC_EVENT_LEN 18
static void
avdtp_signaling_emit_media_codec_mpeg_aac_configuration(avdtp_stream_endpoint_t *stream_endpoint, uint16_t avdtp_cid,
uint8_t reconfigure, avdtp_media_type_t media_type,
static uint16_t
avdtp_signaling_setup_media_codec_mpec_aac_config_event(uint8_t *event, uint16_t size,
avdtp_stream_endpoint_t *stream_endpoint,
uint16_t avdtp_cid, uint8_t reconfigure,
const uint8_t *media_codec_information) {
btstack_packet_handler_t packet_handler = avdtp_packet_handler_for_stream_endpoint(stream_endpoint);
btstack_assert(size >= MEDIA_CONFIG_MPEG_AUDIO_EVENT_LEN);
uint8_t local_seid = avdtp_local_seid(stream_endpoint);
uint8_t remote_seid = avdtp_remote_seid(stream_endpoint);
uint8_t event[18];
int pos = 0;
uint16_t pos = 0;
event[pos++] = HCI_EVENT_AVDTP_META;
event[pos++] = sizeof(event) - 2;
event[pos++] = MEDIA_CONFIG_MPEG_AAC_EVENT_LEN - 2;
event[pos++] = AVDTP_SUBEVENT_SIGNALING_MEDIA_CODEC_MPEG_AAC_CONFIGURATION;
little_endian_store_16(event, pos, avdtp_cid);
@ -1113,6 +1126,7 @@ avdtp_signaling_emit_media_codec_mpeg_aac_configuration(avdtp_stream_endpoint_t
event[pos++] = local_seid;
event[pos++] = remote_seid;
event[pos++] = reconfigure;
event[pos++] =AVDTP_CODEC_MPEG_2_4_AAC;
uint8_t object_type_bitmap = media_codec_information[0];
uint16_t sampling_frequency_bitmap = (media_codec_information[1] << 4) | (media_codec_information[2] >> 4);
@ -1149,7 +1163,6 @@ avdtp_signaling_emit_media_codec_mpeg_aac_configuration(avdtp_stream_endpoint_t
num_channels = 2;
}
event[pos++] = media_type;
event[pos++] = object_type;
little_endian_store_24(event, pos, sampling_frequency);
pos += 3;
@ -1158,22 +1171,25 @@ avdtp_signaling_emit_media_codec_mpeg_aac_configuration(avdtp_stream_endpoint_t
pos += 3;
event[pos++] = vbr;
(*packet_handler)(HCI_EVENT_PACKET, 0, event, pos);
btstack_assert(MEDIA_CONFIG_MPEG_AAC_EVENT_LEN == pos);
return pos;
}
static void
avdtp_signaling_emit_media_codec_atrac_configuration(avdtp_stream_endpoint_t *stream_endpoint, uint16_t avdtp_cid,
uint8_t reconfigure, avdtp_media_type_t media_type,
const uint8_t *media_codec_information) {
#define MEDIA_CONFIG_ATRAC_EVENT_LEN 18
static uint16_t avdtp_signaling_setup_media_codec_atrac_config_event(uint8_t *event, uint16_t size,
avdtp_stream_endpoint_t *stream_endpoint,
uint16_t avdtp_cid, uint8_t reconfigure,
const uint8_t *media_codec_information) {
btstack_assert(size >= MEDIA_CONFIG_ATRAC_EVENT_LEN);
btstack_packet_handler_t packet_handler = avdtp_packet_handler_for_stream_endpoint(stream_endpoint);
uint8_t local_seid = avdtp_local_seid(stream_endpoint);
uint8_t remote_seid = avdtp_remote_seid(stream_endpoint);
uint8_t event[18];
int pos = 0;
uint16_t pos = 0;
event[pos++] = HCI_EVENT_AVDTP_META;
event[pos++] = sizeof(event) - 2;
event[pos++] = MEDIA_CONFIG_ATRAC_EVENT_LEN - 2;
event[pos++] = AVDTP_SUBEVENT_SIGNALING_MEDIA_CODEC_ATRAC_CONFIGURATION;
little_endian_store_16(event, pos, avdtp_cid);
@ -1181,6 +1197,7 @@ avdtp_signaling_emit_media_codec_atrac_configuration(avdtp_stream_endpoint_t *st
event[pos++] = local_seid;
event[pos++] = remote_seid;
event[pos++] = reconfigure;
event[pos++] = AVDTP_CODEC_ATRAC_FAMILY;
avdtp_atrac_version_t version = (avdtp_atrac_version_t) (media_codec_information[0] >> 5);
uint8_t channel_mode_bitmap = (media_codec_information[0] >> 2) & 0x07;
@ -1218,7 +1235,6 @@ avdtp_signaling_emit_media_codec_atrac_configuration(avdtp_stream_endpoint_t *st
}
}
event[pos++] = media_type;
event[pos++] = (uint8_t) version;
event[pos++] = (uint8_t) channel_mode;
event[pos++] = num_channels;
@ -1229,18 +1245,22 @@ avdtp_signaling_emit_media_codec_atrac_configuration(avdtp_stream_endpoint_t *st
little_endian_store_16(event, pos, maximum_sul);
pos += 2;
(*packet_handler)(HCI_EVENT_PACKET, 0, event, pos);
btstack_assert(pos == MEDIA_CONFIG_ATRAC_EVENT_LEN);
return pos;
}
static void avdtp_signaling_emit_media_codec_other_configuration(avdtp_stream_endpoint_t *stream_endpoint, uint16_t avdtp_cid,
uint8_t reconfigure, adtvp_media_codec_capabilities_t *media_codec) {
#define MEDIA_CONFIG_OTHER_EVENT_LEN (13 + MAX_MEDIA_CODEC_INFORMATION_LENGTH)
static uint16_t avdtp_signaling_setup_media_codec_other_config_event(uint8_t *event, uint16_t size,
avdtp_stream_endpoint_t *stream_endpoint,
uint16_t avdtp_cid, uint8_t reconfigure,
const adtvp_media_codec_capabilities_t *media_codec) {
btstack_assert(size >= MEDIA_CONFIG_OTHER_EVENT_LEN);
btstack_packet_handler_t packet_handler = avdtp_packet_handler_for_stream_endpoint(stream_endpoint);
uint8_t local_seid = avdtp_local_seid(stream_endpoint);
uint8_t remote_seid = avdtp_remote_seid(stream_endpoint);
uint8_t event[MAX_MEDIA_CODEC_INFORMATION_LENGTH + 13];
int pos = 0;
uint16_t pos = 0;
event[pos++] = HCI_EVENT_AVDTP_META;
pos++; // set later
event[pos++] = AVDTP_SUBEVENT_SIGNALING_MEDIA_CODEC_OTHER_CONFIGURATION;
@ -1254,11 +1274,14 @@ static void avdtp_signaling_emit_media_codec_other_configuration(avdtp_stream_en
pos += 2;
little_endian_store_16(event, pos, media_codec->media_codec_information_len);
pos += 2;
btstack_assert(pos == 13);
uint16_t media_codec_len = btstack_min(MAX_MEDIA_CODEC_INFORMATION_LENGTH, media_codec->media_codec_information_len);
(void)memcpy(event + pos, media_codec->media_codec_information, media_codec_len);
pos += media_codec_len;
event[1] = pos - 2;
(*packet_handler)(HCI_EVENT_PACKET, 0, event, pos);
return pos;
}
void avdtp_signaling_emit_delay(uint16_t avdtp_cid, uint8_t local_seid, uint16_t delay) {
@ -1279,35 +1302,42 @@ void avdtp_signaling_emit_configuration(avdtp_stream_endpoint_t *stream_endpoint
avdtp_capabilities_t *configuration, uint16_t configured_service_categories) {
if (get_bit16(configured_service_categories, AVDTP_MEDIA_CODEC)){
uint16_t pos = 0;
// assume MEDIA_CONFIG_OTHER_EVENT_LEN is larger than all other events
uint8_t event[MEDIA_CONFIG_OTHER_EVENT_LEN];
switch (configuration->media_codec.media_codec_type){
case AVDTP_CODEC_SBC: {
avdtp_signaling_emit_media_codec_sbc(stream_endpoint, avdtp_cid, reconfigure,
configuration->media_codec.media_type,
configuration->media_codec.media_codec_information);
}
case AVDTP_CODEC_SBC:
pos = avdtp_signaling_setup_media_codec_sbc_config_event(event, sizeof(event), stream_endpoint,
avdtp_cid, reconfigure,
configuration->media_codec.media_codec_information);
break;
case AVDTP_CODEC_MPEG_1_2_AUDIO:
avdtp_signaling_emit_media_codec_mpeg_audio_configuration(
stream_endpoint, avdtp_cid, reconfigure,
configuration->media_codec.media_type,
configuration->media_codec.media_codec_information);
pos = avdtp_signaling_setup_media_codec_mpeg_audio_config_event(event, sizeof(event), stream_endpoint,
avdtp_cid, reconfigure,
configuration->media_codec.media_codec_information);
break;
case AVDTP_CODEC_MPEG_2_4_AAC:
avdtp_signaling_emit_media_codec_mpeg_aac_configuration(
stream_endpoint, avdtp_cid, reconfigure,
configuration->media_codec.media_type,
configuration->media_codec.media_codec_information);
pos = avdtp_signaling_setup_media_codec_mpec_aac_config_event(event,
sizeof(event),
stream_endpoint, avdtp_cid,
reconfigure,
configuration->media_codec.media_codec_information);
break;
case AVDTP_CODEC_ATRAC_FAMILY:
avdtp_signaling_emit_media_codec_atrac_configuration(
stream_endpoint, avdtp_cid, reconfigure,
configuration->media_codec.media_type,
configuration->media_codec.media_codec_information);
pos = avdtp_signaling_setup_media_codec_atrac_config_event(event, sizeof(event), stream_endpoint,
avdtp_cid,
reconfigure,
configuration->media_codec.media_codec_information);
break;
default:
avdtp_signaling_emit_media_codec_other_configuration(stream_endpoint, avdtp_cid, reconfigure, &configuration->media_codec);
pos = avdtp_signaling_setup_media_codec_other_config_event(event, sizeof(event), stream_endpoint,
avdtp_cid,
reconfigure,
&configuration->media_codec);
break;
}
btstack_packet_handler_t packet_handler = avdtp_packet_handler_for_stream_endpoint(stream_endpoint);
(*packet_handler)(HCI_EVENT_PACKET, 0, event, pos);
}
}