mirror/btstack
1
0
Fork 0
mirror of https://github.com/bluekitchen/btstack.git synced 2025-02-08 00:40:11 +00:00
Code Issues Packages Projects Releases Wiki Activity

gatt-service: add le_audio_util

Browse Source
This commit is contained in:
Matthias Ringwald 2022-09-20 11:25:09 +02:00
parent 4ff168dcbc
commit 841e7c8278
5 changed files with 661 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

1
src/ble/gatt-service/Makefile.inc
View File

@ -13,6 +13,7 @@ SRC_BLE_GATT_SERVICE_FILES = \
heart_rate_service_server.c \
hids_client.c \
hids_device.c \
le_audio_util.c \
mesh_provisioning_service_server.c \
mesh_proxy_service_server.c \
microphone_control_service_server.c \

320
src/ble/gatt-service/le_audio.h Normal file
View File

@ -0,0 +1,320 @@
/*
* Copyright (C) 2022 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
*
*/
/**
* @title Volume Offset Control Service Server
*
*/
#ifndef LE_AUDIO_H
#define LE_AUDIO_H
#include <stdint.h>
#if defined __cplusplus
extern "C" {
#endif
#define LE_AUDIO_MAX_CODEC_CONFIG_SIZE 19
#define LE_CCIDS_MAX_NUM 10
#define LE_AUDIO_PROGRAM_INFO_MAX_LENGTH 20
#define LE_AUDIO_PROGRAM_INFO_URI_MAX_LENGTH 20
#define LE_AUDIO_EXTENDED_METADATA_MAX_LENGHT 20
#define LE_AUDIO_VENDOR_SPECIFIC_METADATA_MAX_LENGTH 20
// Generic Audio/Audio Location Definitions/Bitmap
#define LE_AUDIO_LOCATION_MASK_NOT_ALLOWED 0x00000000
#define LE_AUDIO_LOCATION_MASK_FRONT_LEFT 0x00000001
#define LE_AUDIO_LOCATION_MASK_FRONT_RIGHT 0x00000002
#define LE_AUDIO_LOCATION_MASK_FRONT_CENTER 0x00000004
#define LE_AUDIO_LOCATION_MASK_LOW_FREQUENCY_EFFECTS1 0x00000008
#define LE_AUDIO_LOCATION_MASK_BACK_LEFT 0x00000010
#define LE_AUDIO_LOCATION_MASK_BACK_RIGHT 0x00000020
#define LE_AUDIO_LOCATION_MASK_FRONT_LEFT_OF_CENTER 0x00000040
#define LE_AUDIO_LOCATION_MASK_FRONT_RIGHT_OF_CENTER 0x00000080
#define LE_AUDIO_LOCATION_MASK_BACK_CENTER 0x00000100
#define LE_AUDIO_LOCATION_MASK_LOW_FREQUENCY_EFFECTS2 0x00000200
#define LE_AUDIO_LOCATION_MASK_SIDE_LEFT 0x00000400
#define LE_AUDIO_LOCATION_MASK_SIDE_RIGHT 0x00000800
#define LE_AUDIO_LOCATION_MASK_TOP_FRONT_LEFT 0x00001000
#define LE_AUDIO_LOCATION_MASK_TOP_FRONT_RIGHT 0x00002000
#define LE_AUDIO_LOCATION_MASK_TOP_FRONT_CENTER 0x00004000
#define LE_AUDIO_LOCATION_MASK_TOP_CENTER 0x00008000
#define LE_AUDIO_LOCATION_MASK_TOP_BACK_LEFT 0x00010000
#define LE_AUDIO_LOCATION_MASK_TOP_BACK_RIGHT 0x00020000
#define LE_AUDIO_LOCATION_MASK_TOP_SIDE_LEFT 0x00040000
#define LE_AUDIO_LOCATION_MASK_TOP_SIDE_RIGHT 0x00080000
#define LE_AUDIO_LOCATION_MASK_TOP_BACK_CENTER 0x00100000
#define LE_AUDIO_LOCATION_MASK_BOTTOM_FRONT_CENTER 0x00200000
#define LE_AUDIO_LOCATION_MASK_BOTTOM_FRONT_LEFT 0x00400000
#define LE_AUDIO_LOCATION_MASK_BOTTOM_FRONT_RIGHT 0x00800000
#define LE_AUDIO_LOCATION_MASK_FRONT_LEFT_WIDE 0x01000000
#define LE_AUDIO_LOCATION_MASK_FRONT_RIGHT_WIDE 0x02000000
#define LE_AUDIO_LOCATION_MASK_LEFT_SURROUND 0x04000000
#define LE_AUDIO_LOCATION_MASK_RIGHT_SURROUND 0x08000000
#define LE_AUDIO_LOCATION_MASK_RFU 0xF0000000
// Generic Audio/Context Mask
#define LE_AUDIO_CONTEXT_MASK_PROHIBITED 0x0000
#define LE_AUDIO_CONTEXT_MASK_UNSPECIFIED 0x0001
#define LE_AUDIO_CONTEXT_MASK_CONVERSATIONAL 0x0002 // Conversation between humans, for example, in telephony or video calls, including traditional cellular as well as VoIP and Push-to-Talk
#define LE_AUDIO_CONTEXT_MASK_MEDIA 0x0004 // Media, for example, music playback, radio, podcast or movie soundtrack, or tv audio
#define LE_AUDIO_CONTEXT_MASK_GAME 0x0008 // Audio associated with video gaming, for example gaming media; gaming effects; music and in-game voice chat between participants; or a mix of all the above
#define LE_AUDIO_CONTEXT_MASK_INSTRUCTIONAL 0x0010 // Instructional audio, for example, in navigation, announcements, or user guidance
#define LE_AUDIO_CONTEXT_MASK_VOICE_ASSISTANTS 0x0020 // Man-machine communication, for example, with voice recognition or virtual assistants
#define LE_AUDIO_CONTEXT_MASK_LIVE 0x0040 // Live audio, for example, from a microphone where audio is perceived both through a direct acoustic path and through an LE Audio Stream
#define LE_AUDIO_CONTEXT_MASK_SOUND_EFFECTS 0x0080 // Sound effects including keyboard and touch feedback; menu and user interface sounds; and other system sounds
#define LE_AUDIO_CONTEXT_MASK_NOTIFICATIONS 0x0100 // Notification and reminder sounds; attention-seeking audio, for example, in beeps signaling the arrival of a message
#define LE_AUDIO_CONTEXT_MASK_RINGTONE 0x0200 // Alerts the user to an incoming call, for example, an incoming telephony or video call, including traditional cellular as well as VoIP and Push-to-Talk
#define LE_AUDIO_CONTEXT_MASK_ALERTS 0x0400 // Alarms and timers; immediate alerts, for example, in a critical battery alarm, timer expiry or alarm clock, toaster, cooker, kettle, microwave, etc.
#define LE_AUDIO_CONTEXT_MASK_EMERGENCY_ALARM 0x0800 //Emergency alarm Emergency sounds, for example, fire alarms or other urgent alerts
#define LE_AUDIO_CONTEXT_MASK_RFU 0xF000
#define LE_AUDIO_OTC_MIN_OBJECT_ID_VALUE 0x000000000100
#define LE_AUDIO_OTC_MAX_OBJECT_ID_VALUE 0xFFFFFFFFFFFF
// ASCS: Framing for Codec Configured State
#define LE_AUDIO_UNFRAMED_ISOAL_MASK_PDUS_SUPPORTED 0x00
#define LE_AUDIO_UNFRAMED_ISOAL_MASK_PDUS_NOT_SUPPORTED 0x01
// ASCS: Server responds with bitmap values: PHY Bitmap for Codec Configured State
#define LE_AUDIO_SERVER_PHY_MASK_NO_PREFERENCE 0x00
#define LE_AUDIO_SERVER_PHY_MASK_1M 0x01
#define LE_AUDIO_SERVER_PHY_MASK_2M 0x02
#define LE_AUDIO_SERVER_PHY_MASK_CODED 0x04
// ASCS: Latency for Codec Configured State
#define LE_AUDIO_SERVER_LATENCY_MASK_NO_PREFERENCE 0x00
#define LE_AUDIO_SERVER_LATENCY_MASK_LOW 0x01
#define LE_AUDIO_SERVER_LATENCY_MASK_BALANCED 0x02
#define LE_AUDIO_SERVER_LATENCY_MASK_HIGH 0x04
typedef enum {
LE_AUDIO_ROLE_SINK = 0,
LE_AUDIO_ROLE_SOURCE
} le_audio_role_t;
// GA Codec_Specific_Configuration LTV structures
typedef enum {
LE_AUDIO_CODEC_CONFIGURATION_TYPE_SAMPLING_FREQUENCY = 0x01,
LE_AUDIO_CODEC_CONFIGURATION_TYPE_FRAME_DURATION,
LE_AUDIO_CODEC_CONFIGURATION_TYPE_AUDIO_CHANNEL_ALLOCATION,
LE_AUDIO_CODEC_CONFIGURATION_TYPE_OCTETS_PER_CODEC_FRAME,
LE_AUDIO_CODEC_CONFIGURATION_TYPE_CODEC_FRAME_BLOCKS_PER_SDU,
LE_AUDIO_CODEC_CONFIGURATION_TYPE_RFU
} le_audio_codec_configuration_type_t;
typedef enum {
LE_AUDIO_CODEC_CAPABILITY_TYPE_SAMPLING_FREQUENCY = 0x01,
LE_AUDIO_CODEC_CAPABILITY_TYPE_FRAME_DURATION,
LE_AUDIO_CODEC_CAPABILITY_TYPE_SUPPORTED_AUDIO_CHANNEL_COUNTS,
LE_AUDIO_CODEC_CAPABILITY_TYPE_OCTETS_PER_CODEC_FRAME,
LE_AUDIO_CODEC_CAPABILITY_TYPE_CODEC_FRAME_BLOCKS_PER_SDU,
LE_AUDIO_CODEC_CAPABILITY_TYPE_RFU
} le_audio_codec_capability_type_t;
#define LE_AUDIO_CODEC_SAMPLING_FREQUENCY_MASK_8000_HZ 0x0001
#define LE_AUDIO_CODEC_SAMPLING_FREQUENCY_MASK_11025_HZ 0x0002
#define LE_AUDIO_CODEC_SAMPLING_FREQUENCY_MASK_16000_HZ 0x0004
#define LE_AUDIO_CODEC_SAMPLING_FREQUENCY_MASK_22050_HZ 0x0008
#define LE_AUDIO_CODEC_SAMPLING_FREQUENCY_MASK_24000_HZ 0x0010
#define LE_AUDIO_CODEC_SAMPLING_FREQUENCY_MASK_32000_HZ 0x0020
#define LE_AUDIO_CODEC_SAMPLING_FREQUENCY_MASK_44100_HZ 0x0040
#define LE_AUDIO_CODEC_SAMPLING_FREQUENCY_MASK_48000_HZ 0x0080
#define LE_AUDIO_CODEC_SAMPLING_FREQUENCY_MASK_88200_HZ 0x0100
#define LE_AUDIO_CODEC_SAMPLING_FREQUENCY_MASK_96000_HZ 0x0200
#define LE_AUDIO_CODEC_SAMPLING_FREQUENCY_MASK_176400_HZ 0x0400
#define LE_AUDIO_CODEC_SAMPLING_FREQUENCY_MASK_192000_HZ 0x0800
#define LE_AUDIO_CODEC_SAMPLING_FREQUENCY_MASK_384000_HZ 0x1000
typedef enum {
LE_AUDIO_CODEC_SAMPLING_FREQUENCY_INDEX_INVALID = 0x00,
LE_AUDIO_CODEC_SAMPLING_FREQUENCY_INDEX_8000_HZ,
LE_AUDIO_CODEC_SAMPLING_FREQUENCY_INDEX_11025_HZ,
LE_AUDIO_CODEC_SAMPLING_FREQUENCY_INDEX_16000_HZ,
LE_AUDIO_CODEC_SAMPLING_FREQUENCY_INDEX_22050_HZ,
LE_AUDIO_CODEC_SAMPLING_FREQUENCY_INDEX_24000_HZ,
LE_AUDIO_CODEC_SAMPLING_FREQUENCY_INDEX_32000_HZ,
LE_AUDIO_CODEC_SAMPLING_FREQUENCY_INDEX_44100_HZ,
LE_AUDIO_CODEC_SAMPLING_FREQUENCY_INDEX_48000_HZ,
LE_AUDIO_CODEC_SAMPLING_FREQUENCY_INDEX_88200_HZ,
LE_AUDIO_CODEC_SAMPLING_FREQUENCY_INDEX_96000_HZ,
LE_AUDIO_CODEC_SAMPLING_FREQUENCY_INDEX_176400_HZ,
LE_AUDIO_CODEC_SAMPLING_FREQUENCY_INDEX_192000_HZ,
LE_AUDIO_CODEC_SAMPLING_FREQUENCY_INDEX_384000_HZ,
LE_AUDIO_CODEC_SAMPLING_FREQUENCY_INDEX_RFU
} le_audio_codec_sampling_frequency_index_t;
#define LE_AUDIO_CODEC_FRAME_DURATION_MASK_7500US 0x00
#define LE_AUDIO_CODEC_FRAME_DURATION_MASK_10000US 0x01
#define LE_AUDIO_CODEC_FRAME_DURATION_MASK_7500US_PREFERRED 0x08
#define LE_AUDIO_CODEC_FRAME_DURATION_MASK_10000US_PREFERRED 0x10
typedef enum {
LE_AUDIO_CODEC_FRAME_DURATION_INDEX_INVALID = 0x00,
LE_AUDIO_CODEC_FRAME_DURATION_INDEX_7500US,
LE_AUDIO_CODEC_FRAME_DURATION_INDEX_10000US,
LE_AUDIO_CODEC_FRAME_DURATION_INDEX_RFU
} le_audio_codec_frame_duration_index_t;
#define LE_AUDIO_CODEC_AUDIO_CHANNEL_COUNT_MASK_1 0x01
#define LE_AUDIO_CODEC_AUDIO_CHANNEL_COUNT_MASK_2 0x02
#define LE_AUDIO_CODEC_AUDIO_CHANNEL_COUNT_MASK_3 0x04
#define LE_AUDIO_CODEC_AUDIO_CHANNEL_COUNT_MASK_4 0x08
#define LE_AUDIO_CODEC_AUDIO_CHANNEL_COUNT_MASK_5 0x10
#define LE_AUDIO_CODEC_AUDIO_CHANNEL_COUNT_MASK_6 0x20
#define LE_AUDIO_CODEC_AUDIO_CHANNEL_COUNT_MASK_7 0x40
#define LE_AUDIO_CODEC_AUDIO_CHANNEL_COUNT_MASK_8 0x80
// GA Metadata LTV structures
typedef enum {
LE_AUDIO_METADATA_TYPE_PREFERRED_AUDIO_CONTEXTS = 0x01,
LE_AUDIO_METADATA_TYPE_STREAMING_AUDIO_CONTEXTS,
LE_AUDIO_METADATA_TYPE_PROGRAM_INFO,
LE_AUDIO_METADATA_TYPE_LANGUAGE,
LE_AUDIO_METADATA_TYPE_CCID_LIST,
LE_AUDIO_METADATA_TYPE_PARENTAL_RATING,
LE_AUDIO_METADATA_TYPE_PROGRAM_INFO_URI,
LE_AUDIO_METADATA_TYPE_MAPPED_EXTENDED_METADATA_BIT_POSITION,
LE_AUDIO_METADATA_TYPE_MAPPED_VENDOR_SPECIFIC_METADATA_BIT_POSITION,
// also used to indicate invalid packet type
LE_AUDIO_METADATA_TYPE_RFU,
LE_AUDIO_METADATA_TYPE_EXTENDED_METADATA = 0xFE, // mapped on RFU
LE_AUDIO_METADATA_TYPE_VENDOR_SPECIFIC_METADATA = 0xFF // mapped on RFU+1
} le_audio_metadata_type_t;
typedef enum {
LE_AUDIO_PARENTAL_RATING_NO_RATING = 0,
LE_AUDIO_PARENTAL_RATING_ANY_AGE,
LE_AUDIO_PARENTAL_RATING_AGE_2,
LE_AUDIO_PARENTAL_RATING_AGE_3,
LE_AUDIO_PARENTAL_RATING_AGE_4,
LE_AUDIO_PARENTAL_RATING_AGE_6,
LE_AUDIO_PARENTAL_RATING_AGE_7,
LE_AUDIO_PARENTAL_RATING_AGE_8,
LE_AUDIO_PARENTAL_RATING_AGE_9,
LE_AUDIO_PARENTAL_RATING_AGE_10,
LE_AUDIO_PARENTAL_RATING_RFU = 0x08
} le_audio_parental_rating_t;
typedef enum {
LE_AUDIO_CLIENT_TARGET_LATENCY_NO_PREFERENCE = 0,
LE_AUDIO_CLIENT_TARGET_LATENCY_LOW_LATENCY,
LE_AUDIO_CLIENT_TARGET_LATENCY_BALANCED_LATENCY_AND_RELIABILITY,
LE_AUDIO_CLIENT_TARGET_LATENCY_HIGH_RELIABILITY,
LE_AUDIO_CLIENT_TARGET_LATENCY_RFU,
} le_audio_client_target_latency_t;
typedef enum {
LE_AUDIO_CLIENT_TARGET_PHY_NO_PREFERENCE = 0,
LE_AUDIO_CLIENT_TARGET_PHY_LOW,
LE_AUDIO_CLIENT_TARGET_PHY_BALANCED,
LE_AUDIO_CLIENT_TARGET_PHY_HIGH,
LE_AUDIO_CLIENT_TARGET_PHY_RFU
} le_audio_client_target_phy_t;
// struct for codec id
typedef struct {
hci_audio_coding_format_t coding_format;
uint16_t company_id;
uint16_t vendor_specific_codec_id;
} le_audio_codec_id_t;
typedef enum {
LE_AUDIO_PA_SYNC_DO_NOT_SYNCHRONIZE_TO_PA = 0x00,
LE_AUDIO_PA_SYNC_SYNCHRONIZE_TO_PA_PAST_AVAILABLE,
LE_AUDIO_PA_SYNC_SYNCHRONIZE_TO_PA_PAST_NOT_AVAILABLE,
LE_AUDIO_PA_SYNC_RFU
} le_audio_pa_sync_t;
typedef enum {
LE_AUDIO_PA_SYNC_STATE_NOT_SYNCHRONIZED_TO_PA = 0x00,
LE_AUDIO_PA_SYNC_STATE_SYNCINFO_REQUEST,
LE_AUDIO_PA_SYNC_STATE_SYNCHRONIZED_TO_PA,
LE_AUDIO_PA_SYNC_STATE_FAILED_TO_SYNCHRONIZE_TO_PA,
LE_AUDIO_PA_SYNC_STATE_NO_PAST,
LE_AUDIO_PA_SYNC_STATE_RFU
} le_audio_pa_sync_state_t;
typedef enum {
LE_AUDIO_BIG_ENCRYPTION_NOT_ENCRYPTED = 0x00,
LE_AUDIO_BIG_ENCRYPTION_BROADCAST_CODE_REQUIRED,
LE_AUDIO_BIG_ENCRYPTION_DECRYPTING,
LE_AUDIO_BIG_ENCRYPTION_BAD_CODE,
LE_AUDIO_BIG_ENCRYPTION_RFU
} le_audio_big_encryption_t;
typedef struct {
uint16_t metadata_mask;
uint16_t preferred_audio_contexts_mask;
uint16_t streaming_audio_contexts_mask;
uint8_t program_info_length;
uint8_t program_info[LE_AUDIO_PROGRAM_INFO_MAX_LENGTH];
uint32_t language_code; // 3-byte, lower case language code as defined in ISO 639-3
uint8_t ccids_num;
uint8_t ccids[LE_CCIDS_MAX_NUM];
le_audio_parental_rating_t parental_rating;
uint8_t program_info_uri_length;
uint8_t program_info_uri[LE_AUDIO_PROGRAM_INFO_URI_MAX_LENGTH];
uint16_t extended_metadata_type;
uint8_t extended_metadata_length;
uint8_t extended_metadata[LE_AUDIO_EXTENDED_METADATA_MAX_LENGHT];
uint16_t vendor_specific_company_id;
uint8_t vendor_specific_metadata_length;
uint8_t vendor_specific_metadata[LE_AUDIO_VENDOR_SPECIFIC_METADATA_MAX_LENGTH];
} le_audio_metadata_t;
#if defined __cplusplus
}
#endif
#endif

270
src/ble/gatt-service/le_audio_util.c Normal file
View File

@ -0,0 +1,270 @@
/*
* Copyright (C) 2022 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__ "le_audio_util.c"
#include "btstack_util.h"
#include "btstack_debug.h"
#include "ble/gatt-service/le_audio_util.h"
// help with buffer == NULL
uint16_t le_audio_virtual_memcpy_helper(
const uint8_t * field_data, uint16_t field_len, uint16_t field_offset,
uint8_t * buffer, uint16_t buffer_size, uint16_t buffer_offset){
// only calc total size
if (buffer == NULL) {
return field_len;
}
return btstack_virtual_memcpy(field_data, field_len, field_offset, buffer, buffer_size, buffer_offset);
}
uint16_t le_audio_virtual_memcpy_metadata(const le_audio_metadata_t * metadata, uint8_t metadata_length, uint16_t * records_offset, uint8_t * buffer, uint16_t buffer_size, uint16_t buffer_offset){
uint16_t metadata_type;
uint8_t field_data[7];
uint16_t stored_bytes = 0;
uint16_t metadata_length_pos = *records_offset;
field_data[0] = 0;
stored_bytes += le_audio_virtual_memcpy_helper(field_data, 1, *records_offset, buffer, buffer_size, buffer_offset);
*records_offset += 1;
if (metadata_length == 0){
return stored_bytes;
}
for (metadata_type = (uint16_t)LE_AUDIO_METADATA_TYPE_PREFERRED_AUDIO_CONTEXTS; metadata_type < (uint16_t) LE_AUDIO_METADATA_TYPE_RFU; metadata_type++){
if ((metadata->metadata_mask & (1 << metadata_type) ) != 0 ){
// reserve field_data[0] for num butes to store
field_data[0] = 1;
field_data[1] = metadata_type;
switch ((le_audio_metadata_type_t)metadata_type){
case LE_AUDIO_METADATA_TYPE_PREFERRED_AUDIO_CONTEXTS:
field_data[0] += 2;
little_endian_store_16(field_data, 2, metadata->preferred_audio_contexts_mask);
stored_bytes += le_audio_virtual_memcpy_helper(field_data, field_data[0] + 1, *records_offset, buffer, buffer_size, buffer_offset);
*records_offset += field_data[0] + 1;
break;
case LE_AUDIO_METADATA_TYPE_STREAMING_AUDIO_CONTEXTS:
field_data[0] += 2;
little_endian_store_16(field_data, 2, metadata->streaming_audio_contexts_mask);
stored_bytes += le_audio_virtual_memcpy_helper(field_data, field_data[0] + 1, *records_offset, buffer, buffer_size, buffer_offset);
*records_offset += field_data[0] + 1;
break;
case LE_AUDIO_METADATA_TYPE_PROGRAM_INFO:
field_data[0] += metadata->program_info_length;
stored_bytes += le_audio_virtual_memcpy_helper(field_data, 2, *records_offset, buffer, buffer_size, buffer_offset);
*records_offset += 2;
stored_bytes += le_audio_virtual_memcpy_helper(metadata->program_info, metadata->program_info_length, *records_offset, buffer, buffer_size, buffer_offset);
*records_offset += metadata->program_info_length;
break;
case LE_AUDIO_METADATA_TYPE_LANGUAGE:
field_data[0] += 3;
little_endian_store_24(field_data, 2, metadata->language_code);
stored_bytes += le_audio_virtual_memcpy_helper(field_data, field_data[0] + 1, *records_offset, buffer, buffer_size, buffer_offset);
*records_offset += field_data[0] + 1;
break;
case LE_AUDIO_METADATA_TYPE_CCID_LIST:
field_data[0] += metadata->ccids_num;
stored_bytes += le_audio_virtual_memcpy_helper(field_data, 2, *records_offset, buffer, buffer_size, buffer_offset);
*records_offset += 2;
stored_bytes += le_audio_virtual_memcpy_helper(metadata->ccids, metadata->ccids_num, *records_offset, buffer, buffer_size, buffer_offset);
*records_offset += metadata->ccids_num;
break;
case LE_AUDIO_METADATA_TYPE_PARENTAL_RATING:
field_data[0] += 1;
field_data[2] = (uint8_t) metadata->parental_rating;
stored_bytes += le_audio_virtual_memcpy_helper(field_data, field_data[0] + 1, *records_offset, buffer, buffer_size, buffer_offset);
*records_offset += field_data[0] + 1;
break;
case LE_AUDIO_METADATA_TYPE_PROGRAM_INFO_URI:
field_data[0] += metadata->program_info_uri_length;
stored_bytes += le_audio_virtual_memcpy_helper(field_data, 2, *records_offset, buffer, buffer_size, buffer_offset);
*records_offset += 2;
stored_bytes += le_audio_virtual_memcpy_helper(metadata->program_info_uri, metadata->program_info_uri_length, *records_offset, buffer, buffer_size, buffer_offset);
*records_offset += metadata->program_info_uri_length;
break;
case LE_AUDIO_METADATA_TYPE_MAPPED_EXTENDED_METADATA_BIT_POSITION:
field_data[0] += 2 + metadata->extended_metadata_length;
field_data[1] = LE_AUDIO_METADATA_TYPE_EXTENDED_METADATA;
little_endian_store_16(field_data, 2, metadata->extended_metadata_type);
stored_bytes += le_audio_virtual_memcpy_helper(field_data, 4, *records_offset, buffer, buffer_size, buffer_offset);
*records_offset += 4;
stored_bytes += le_audio_virtual_memcpy_helper(metadata->extended_metadata, metadata->extended_metadata_length, *records_offset, buffer, buffer_size, buffer_offset);
*records_offset += metadata->extended_metadata_length;
break;
case LE_AUDIO_METADATA_TYPE_MAPPED_VENDOR_SPECIFIC_METADATA_BIT_POSITION:
field_data[0] += 2 + metadata->vendor_specific_metadata_length;
field_data[1] = LE_AUDIO_METADATA_TYPE_VENDOR_SPECIFIC_METADATA;
little_endian_store_16(field_data, 2, metadata->vendor_specific_company_id);
stored_bytes += le_audio_virtual_memcpy_helper(field_data, 4, *records_offset, buffer, buffer_size, buffer_offset);
*records_offset += 4;
stored_bytes += le_audio_virtual_memcpy_helper(metadata->vendor_specific_metadata, metadata->vendor_specific_metadata_length, *records_offset, buffer, buffer_size, buffer_offset);
*records_offset += metadata->vendor_specific_metadata_length;
break;
default:
btstack_assert(false);
break;
}
}
}
field_data[0] = *records_offset - metadata_length_pos - 1;
le_audio_virtual_memcpy_helper(field_data, 1, metadata_length_pos, buffer, buffer_size, buffer_offset);
return stored_bytes;
}
uint16_t le_audio_metadata_parse_tlv(uint8_t * buffer, uint8_t buffer_size, le_audio_metadata_t * metadata){
// parse config to get sampling frequency and frame duration
uint8_t offset = 0;
uint8_t metadata_config_lenght = buffer[offset++];
if (buffer_size < metadata_config_lenght){
return 0;
}
metadata->metadata_mask = 0;
while ((offset + 1) < metadata_config_lenght){
uint8_t ltv_len = buffer[offset++];
le_audio_metadata_type_t ltv_type = (le_audio_metadata_type_t)buffer[offset];
le_audio_parental_rating_t parental_rating;
switch (ltv_type){
case LE_AUDIO_METADATA_TYPE_PREFERRED_AUDIO_CONTEXTS:
metadata->preferred_audio_contexts_mask = little_endian_read_16(buffer, offset+1);
metadata->metadata_mask |= (1 << ltv_type);
break;
case LE_AUDIO_METADATA_TYPE_STREAMING_AUDIO_CONTEXTS:
metadata->streaming_audio_contexts_mask = little_endian_read_16(buffer, offset+1);
metadata->metadata_mask |= (1 << ltv_type);
break;
case LE_AUDIO_METADATA_TYPE_PROGRAM_INFO:
metadata->program_info_length = btstack_min(ltv_len, LE_AUDIO_PROGRAM_INFO_MAX_LENGTH);
memcpy(metadata->program_info, &buffer[offset+1], metadata->program_info_length);
metadata->metadata_mask |= (1 << ltv_type);
break;
case LE_AUDIO_METADATA_TYPE_LANGUAGE:
metadata->language_code = little_endian_read_24(buffer, offset+1);
metadata->metadata_mask |= (1 << ltv_type);
break;
case LE_AUDIO_METADATA_TYPE_CCID_LIST:
metadata->ccids_num = btstack_min(ltv_len, LE_CCIDS_MAX_NUM);
memcpy(metadata->ccids, &buffer[offset+1], metadata->ccids_num);
metadata->metadata_mask |= (1 << ltv_type);
break;
case LE_AUDIO_METADATA_TYPE_PARENTAL_RATING:
parental_rating = (le_audio_parental_rating_t)buffer[offset+1];
metadata->parental_rating = parental_rating;
metadata->metadata_mask |= (1 << ltv_type);
break;
case LE_AUDIO_METADATA_TYPE_PROGRAM_INFO_URI:
metadata->program_info_uri_length = btstack_min(ltv_len, LE_AUDIO_PROGRAM_INFO_URI_MAX_LENGTH);
memcpy(metadata->program_info_uri, &buffer[offset+1], metadata->program_info_uri_length);
metadata->metadata_mask |= (1 << ltv_type);
break;
case LE_AUDIO_METADATA_TYPE_EXTENDED_METADATA:
if (ltv_len < 2){
break;
}
metadata->extended_metadata_length = btstack_min(ltv_len - 2, LE_AUDIO_EXTENDED_METADATA_MAX_LENGHT);
metadata->extended_metadata_type = little_endian_read_16(buffer, offset+1);
memcpy(metadata->extended_metadata, &buffer[offset+3], metadata->extended_metadata_length);
metadata->metadata_mask |= (1 << LE_AUDIO_METADATA_TYPE_MAPPED_EXTENDED_METADATA_BIT_POSITION);
break;
case LE_AUDIO_METADATA_TYPE_VENDOR_SPECIFIC_METADATA:
if (ltv_len < 2){
break;
}
metadata->vendor_specific_metadata_length = btstack_min(ltv_len - 2, LE_AUDIO_VENDOR_SPECIFIC_METADATA_MAX_LENGTH);
metadata->vendor_specific_company_id = little_endian_read_16(buffer, offset+1);
memcpy(metadata->vendor_specific_metadata, &buffer[offset+3], metadata->vendor_specific_metadata_length);
metadata->metadata_mask |= (1 << LE_AUDIO_METADATA_TYPE_MAPPED_VENDOR_SPECIFIC_METADATA_BIT_POSITION);
break;
default:
metadata->metadata_mask |= (1 << LE_AUDIO_METADATA_TYPE_RFU);
break;
}
offset += ltv_len;
}
return offset;
}
uint16_t le_audio_copy_metadata_to_event_buffer(le_audio_metadata_t * metadata, uint8_t * event, uint16_t event_size){
uint8_t pos = 0;
event[pos++] = (uint8_t)metadata->metadata_mask;
little_endian_store_16(event, pos, metadata->preferred_audio_contexts_mask);
pos += 2;
little_endian_store_16(event, pos, metadata->streaming_audio_contexts_mask);
pos += 2;
event[pos++] = metadata->program_info_length;
memcpy(&event[pos], &metadata->program_info[0], metadata->program_info_length);
pos += metadata->program_info_length;
little_endian_store_24(event, pos, metadata->language_code);
pos += 3;
event[pos++] = metadata->ccids_num;
memcpy(&event[pos], &metadata->ccids[0], metadata->ccids_num);
pos += metadata->ccids_num;
event[pos++] = (uint8_t)metadata->parental_rating;
event[pos++] = metadata->program_info_uri_length;
memcpy(&event[pos], &metadata->program_info_uri[0], metadata->program_info_uri_length);
pos += metadata->program_info_uri_length;
little_endian_store_16(event, pos, metadata->extended_metadata_type);
pos += 2;
event[pos++] = metadata->extended_metadata_length;
memcpy(&event[pos], &metadata->extended_metadata[0], metadata->extended_metadata_length);
pos += metadata->extended_metadata_length;
little_endian_store_16(event, pos, metadata->vendor_specific_company_id);
pos += 2;
event[pos++] = metadata->vendor_specific_metadata_length;
memcpy(&event[pos], &metadata->vendor_specific_metadata[0], metadata->vendor_specific_metadata_length);
pos += metadata->vendor_specific_metadata_length;
return pos;
}

68
src/ble/gatt-service/le_audio_util.h Normal file
View File

@ -0,0 +1,68 @@
/*
* Copyright (C) 2022 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
*
*/
/**
* @title LE Audio Util
*
*/
#ifndef LE_AUDIO_UTIL_H
#define LE_AUDIO_UTIL_H
#include <stdint.h>
#include "le_audio.h"
#if defined __cplusplus
extern "C" {
#endif
uint16_t le_audio_virtual_memcpy_helper(
const uint8_t * field_data, uint16_t field_len, uint16_t field_offset,
uint8_t * buffer, uint16_t buffer_size, uint16_t buffer_offset);
uint16_t le_audio_virtual_memcpy_metadata(const le_audio_metadata_t * metadata, uint8_t metadata_length, uint16_t * records_offset, uint8_t * buffer, uint16_t buffer_size, uint16_t buffer_offset);
uint16_t le_audio_metadata_parse_tlv(uint8_t * buffer, uint8_t buffer_size, le_audio_metadata_t * metadata);
uint16_t le_audio_copy_metadata_to_event_buffer(le_audio_metadata_t * metadata, uint8_t * event, uint16_t event_size);
#if defined __cplusplus
}
#endif
#endif

2
src/btstack.h
View File

@ -94,6 +94,8 @@
#include "ble/gatt-service/heart_rate_service_server.h"
#include "ble/gatt-service/hids_client.h"
#include "ble/gatt-service/hids_device.h"
#include "ble/gatt-service/le_audio.h"
#include "ble/gatt-service/le_audio_util.h"
#include "ble/gatt-service/microphone_control_service_client.h"
#include "ble/gatt-service/microphone_control_service_server.h"
#include "ble/gatt-service/scan_parameters_service_client.h"