mirror of
https://github.com/bluekitchen/btstack.git
synced 2025-01-30 15:32:41 +00:00
classic: introduce hfp_codec.c, replacing hfp_msbc, ready for other codecs
This commit is contained in:
Matthias Ringwald
parent
515a576f9b
commit
a602f23dae
130
src/classic/hfp_codec.c
Normal file
130
src/classic/hfp_codec.c
Normal file
@ -0,0 +1,130 @@
|
||||
/*
|
||||
* Copyright (C) 2023 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__ "hfp_codec.c"
|
||||
|
||||
// *****************************************************************************
|
||||
//
|
||||
// HFP Codec
|
||||
//
|
||||
// *****************************************************************************
|
||||
|
||||
#include "btstack_config.h"
|
||||
|
||||
#include <string.h>
|
||||
|
||||
#include "hfp_codec.h"
|
||||
#include "btstack_debug.h"
|
||||
|
||||
#ifdef ENABLE_HFP_WIDE_BAND_SPEECH
|
||||
#include "btstack_sbc.h"
|
||||
#define FRAME_SIZE_MSBC 57
|
||||
static void hfp_codec_encode_msbc(hfp_codec_t * hfp_codec, int16_t * pcm_samples);
|
||||
#endif
|
||||
|
||||
#include "hfp_codec.h"
|
||||
|
||||
void hfp_codec_init(hfp_codec_t * hfp_codec, uint8_t codec_id){
|
||||
memset(hfp_codec, 0, sizeof(hfp_codec_t));
|
||||
hfp_h2_framing_init(&hfp_codec->h2_framing);
|
||||
switch (codec_id){
|
||||
#ifdef ENABLE_HFP_WIDE_BAND_SPEECH
|
||||
case HFP_CODEC_MSBC:
|
||||
hfp_codec->samples_per_frame = 120;
|
||||
hfp_codec->encode = &hfp_codec_encode_msbc;
|
||||
btstack_sbc_encoder_init(&hfp_codec->msbc_state, SBC_MODE_mSBC, 16, 8, SBC_ALLOCATION_METHOD_LOUDNESS, 16000, 26, SBC_CHANNEL_MODE_MONO);
|
||||
break;
|
||||
#endif
|
||||
default:
|
||||
btstack_assert(false);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
bool hfp_codec_can_encode_audio_frame_now(const hfp_codec_t * hfp_codec){
|
||||
return hfp_codec->read_pos == hfp_codec->write_pos;
|
||||
}
|
||||
|
||||
uint16_t hfp_codec_num_audio_samples_per_frame(const hfp_codec_t * hfp_codec){
|
||||
return hfp_codec->samples_per_frame;
|
||||
}
|
||||
|
||||
#ifdef ENABLE_HFP_WIDE_BAND_SPEECH
|
||||
static void hfp_codec_encode_msbc(hfp_codec_t * hfp_codec, int16_t * pcm_samples){
|
||||
// Synchronization Header H2
|
||||
hfp_h2_framing_add_header(&hfp_codec->h2_framing, hfp_codec->sco_packet);
|
||||
hfp_codec->write_pos += 2;
|
||||
|
||||
// Encode SBC Frame
|
||||
btstack_sbc_encoder_process_data(pcm_samples);
|
||||
(void)memcpy(&hfp_codec->sco_packet[hfp_codec->write_pos],
|
||||
btstack_sbc_encoder_sbc_buffer(), FRAME_SIZE_MSBC);
|
||||
hfp_codec->write_pos += FRAME_SIZE_MSBC;
|
||||
|
||||
// Final padding to use 60 bytes
|
||||
hfp_codec->sco_packet[hfp_codec->write_pos++] = 0;
|
||||
}
|
||||
#endif
|
||||
|
||||
void hfp_codec_encode_audio_frame(hfp_codec_t * hfp_codec, int16_t * pcm_samples){
|
||||
btstack_assert(hfp_codec_can_encode_audio_frame_now(hfp_codec));
|
||||
|
||||
// reset packet buffer
|
||||
hfp_codec->read_pos = 0;
|
||||
hfp_codec->write_pos = 0;
|
||||
|
||||
// encode
|
||||
hfp_codec->encode(hfp_codec, pcm_samples);
|
||||
}
|
||||
|
||||
uint16_t hfp_codec_num_bytes_available(const hfp_codec_t * hfp_codec){
|
||||
return hfp_codec->write_pos - hfp_codec->read_pos;
|
||||
}
|
||||
|
||||
void hfp_msbc_read_from_stream(hfp_codec_t * hfp_codec, uint8_t * buf, int size){
|
||||
uint16_t num_bytes_available = hfp_codec_num_bytes_available(hfp_codec);
|
||||
btstack_assert(num_bytes_available >= size);
|
||||
|
||||
uint16_t num_bytes_to_copy = btstack_min(num_bytes_available, size);
|
||||
|
||||
memcpy(buf, &hfp_codec->sco_packet[hfp_codec->read_pos], num_bytes_to_copy);
|
||||
hfp_codec->read_pos += num_bytes_to_copy;
|
||||
}
|
||||
|
||||
void hfp_codec_deinit(hfp_codec_t * hfp_codec){
|
||||
UNUSED(hfp_codec);
|
||||
}
|
||||
130
src/classic/hfp_codec.h
Normal file
130
src/classic/hfp_codec.h
Normal file
@ -0,0 +1,130 @@
|
||||
/*
|
||||
* Copyright (C) 2023 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 HFP Audio Encoder
|
||||
* @brief Create SCO packet with H2 Synchronization Header and encoded audio samples
|
||||
*/
|
||||
|
||||
#ifndef HFP_CODEC_H
|
||||
#define HFP_CODEC_H
|
||||
|
||||
#include "btstack_config.h"
|
||||
#include "hfp.h" // hfp_h2_framing
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
#ifdef ENABLE_HFP_WIDE_BAND_SPEECH
|
||||
#include "btstack_sbc.h"
|
||||
#endif
|
||||
|
||||
#if defined __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
struct hfp_codec {
|
||||
uint8_t sco_packet[60];
|
||||
uint16_t read_pos;
|
||||
uint16_t write_pos;
|
||||
uint16_t samples_per_frame;
|
||||
hfp_h2_framing_t h2_framing;
|
||||
void (*encode)(struct hfp_codec * hfp_codec, int16_t * pcm_samples);
|
||||
#ifdef ENABLE_HFP_WIDE_BAND_SPEECH
|
||||
btstack_sbc_encoder_state_t msbc_state;
|
||||
#endif
|
||||
};
|
||||
|
||||
/* API_START */
|
||||
|
||||
typedef struct hfp_codec hfp_codec_t;
|
||||
|
||||
/**
|
||||
* @brief Initialize HFP Audio Codec
|
||||
* @note btstack_assert if codec_id is not supported
|
||||
* @param hfp_codec
|
||||
* @param codec_id see HFP_CODEC_xxx in hfp.h
|
||||
* @return status
|
||||
*/
|
||||
void hfp_codec_init(hfp_codec_t * hfp_codec, uint8_t codec_id);
|
||||
|
||||
/**
|
||||
* @brief Get number of audio samples per HFP SCO frame
|
||||
* @param hfp_codec
|
||||
* @return num audio samples per 7.5ms SCO packet
|
||||
*/
|
||||
uint16_t hfp_codec_num_audio_samples_per_frame(const hfp_codec_t * hfp_codec);
|
||||
|
||||
/**
|
||||
* @brief Checks if next frame can be encoded
|
||||
* @param hfp_codec
|
||||
*/
|
||||
bool hfp_codec_can_encode_audio_frame_now(const hfp_codec_t * hfp_codec);
|
||||
|
||||
/**
|
||||
* Get number of bytes ready for sending
|
||||
* @param hfp_codec
|
||||
* @return num bytes ready for current packet
|
||||
*/
|
||||
uint16_t hfp_codec_num_bytes_available(const hfp_codec_t * hfp_codec);
|
||||
|
||||
/**
|
||||
* Encode audio samples for HFP SCO packet
|
||||
* @param hfp_codec
|
||||
* @param pcm_samples - complete audio frame of hfp_msbc_num_audio_samples_per_frame int16 samples
|
||||
*/
|
||||
void hfp_codec_encode_audio_frame(hfp_codec_t * hfp_codec, int16_t * pcm_samples);
|
||||
|
||||
/**
|
||||
* Read from stream into SCO packet buffer
|
||||
* @param hfp_codec
|
||||
* @param buffer to store stream
|
||||
* @param size num bytes to read from stream
|
||||
*/
|
||||
void hfp_codec_read_from_stream(hfp_codec_t * hfp_codec, uint8_t * buffer, uint16_t size);
|
||||
|
||||
/**
|
||||
* @param hfp_codec
|
||||
*/
|
||||
void hfp_codec_deinit(hfp_codec_t * hfp_codec);
|
||||
|
||||
/* API_END */
|
||||
|
||||
#if defined __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif
|
||||
Loading…
x
Reference in New Issue
Block a user