chore: reorg TX15 files (#6560)
This commit is contained in:
@@ -0,0 +1,156 @@
|
||||
#include "drivers/tas2505.h"
|
||||
|
||||
#include "stm32_dma.h"
|
||||
#include "stm32_i2s.h"
|
||||
#include "stm32_i2c_driver.h"
|
||||
|
||||
#include "stm32_hal_ll.h"
|
||||
#include "timers_driver.h"
|
||||
|
||||
#include "audio.h"
|
||||
#include "debug.h"
|
||||
|
||||
#define DEFAULT_DAC_VOL -15 // -7dB
|
||||
#define DEFAULT_HP_VOL 20
|
||||
#define DEFAULT_SPK_VOL 40
|
||||
|
||||
static tas2505_t _tas2505 = {
|
||||
.ndac = 2,
|
||||
.mdac = 1,
|
||||
.dosr = 256,
|
||||
.dac_vol = DEFAULT_DAC_VOL,
|
||||
.hp_drv = 0,
|
||||
.hp_vol = DEFAULT_HP_VOL,
|
||||
.spk_drv = TAS2505_SPK_DRV_32_DB,
|
||||
.spk_vol = DEFAULT_SPK_VOL,
|
||||
};
|
||||
|
||||
//
|
||||
// TX15 pinout
|
||||
//
|
||||
// Pin MCU TAS2505
|
||||
// ---------------------------------
|
||||
// PC6 (I2S2_MCK): MCLK <-> MCLK
|
||||
// PI0 (I2S2_WS): WCLK <-> WCLK
|
||||
// PI1 (I2S2_CK): BCLK <-> BCLK
|
||||
// PI3 (I2S2_SDO): DOUT <-> DIN
|
||||
// PC2 (I2S2_SDI): DIN <-> DOUT
|
||||
|
||||
|
||||
const stm32_i2s_t _i2s_dev = {
|
||||
.SPIx = AUDIO_SPI,
|
||||
.MCK = {GPIO_PIN(GPIOC, 6), GPIO_AF5},
|
||||
.WS = {GPIO_PIN(GPIOI, 0), GPIO_AF5},
|
||||
.CK = {GPIO_PIN(GPIOI, 1), GPIO_AF5},
|
||||
.SDO = {GPIO_PIN(GPIOI, 3), GPIO_AF5},
|
||||
.SDI = {GPIO_PIN(GPIOI, 2), GPIO_AF5},
|
||||
|
||||
.DMA = I2S_DMA,
|
||||
.DMA_Stream = I2S_DMA_Stream,
|
||||
.DMA_PeriphRequest = I2S_DMA_Stream_Request,
|
||||
};
|
||||
|
||||
// 16 bit, 2 channels
|
||||
#define DMA_BUFFER_HALF_LEN AUDIO_BUFFER_SIZE
|
||||
|
||||
// 2 buffers
|
||||
#define DMA_BUFFER_LEN (DMA_BUFFER_HALF_LEN * 2)
|
||||
|
||||
static int32_t _dma_buffer[DMA_BUFFER_LEN] __DMA_NO_CACHE;
|
||||
|
||||
static void enable_dma_irqs()
|
||||
{
|
||||
LL_DMA_EnableIT_HT(I2S_DMA, I2S_DMA_Stream);
|
||||
LL_DMA_EnableIT_TC(I2S_DMA, I2S_DMA_Stream);
|
||||
|
||||
NVIC_SetPriority(I2S_DMA_Stream_IRQn, 7);
|
||||
NVIC_EnableIRQ(I2S_DMA_Stream_IRQn);
|
||||
}
|
||||
|
||||
int audioInit()
|
||||
{
|
||||
gpio_init(AUDIO_HP_DETECT_PIN, GPIO_IN_PU, GPIO_PIN_SPEED_LOW);
|
||||
|
||||
memset(_dma_buffer, 0, sizeof(_dma_buffer));
|
||||
|
||||
if (tas2505_probe(&_tas2505, AUDIO_I2C, 0x30 >> 1) < 0) {
|
||||
return -1;
|
||||
}
|
||||
|
||||
if (stm32_i2s_init(&_i2s_dev)) {
|
||||
return -1;
|
||||
}
|
||||
|
||||
enable_dma_irqs();
|
||||
return tas2505_init(&_tas2505);
|
||||
}
|
||||
|
||||
static volatile uint32_t _dma_buffer_offset = 0;
|
||||
|
||||
void audioConsumeCurrentBuffer()
|
||||
{
|
||||
if (!stm32_i2s_is_xfer_started(&_i2s_dev)) {
|
||||
|
||||
auto buffer = audioQueue.buffersFifo.getNextFilledBuffer();
|
||||
if (!buffer) return;
|
||||
|
||||
unsigned idx = 0;
|
||||
for (; idx < buffer->size; idx++) {
|
||||
uint32_t offset = _dma_buffer_offset + idx;
|
||||
_dma_buffer[offset] = (uint32_t)buffer->data[idx];
|
||||
}
|
||||
for (; idx < DMA_BUFFER_HALF_LEN; idx++) {
|
||||
uint32_t offset = _dma_buffer_offset + idx;
|
||||
_dma_buffer[offset] = 0;
|
||||
}
|
||||
audioQueue.buffersFifo.freeNextFilledBuffer();
|
||||
stm32_i2s_config_dma_stream(&_i2s_dev, _dma_buffer, DMA_BUFFER_LEN * 2);
|
||||
stm32_i2s_start_dma_stream(&_i2s_dev);
|
||||
}
|
||||
}
|
||||
|
||||
static inline uint32_t _calc_offset(uint8_t tc)
|
||||
{
|
||||
return tc * DMA_BUFFER_HALF_LEN;
|
||||
}
|
||||
|
||||
static void audio_update_dma_buffer(uint8_t tc)
|
||||
{
|
||||
_dma_buffer_offset = _calc_offset(tc);
|
||||
|
||||
auto buffer = audioQueue.buffersFifo.getNextFilledBuffer();
|
||||
if (!buffer) {
|
||||
unsigned idx = 0;
|
||||
for (; idx < DMA_BUFFER_HALF_LEN; idx++) {
|
||||
uint32_t offset = _dma_buffer_offset + idx;
|
||||
_dma_buffer[offset] = 0;
|
||||
}
|
||||
} else {
|
||||
unsigned idx = 0;
|
||||
for (; idx < buffer->size; idx++) {
|
||||
uint32_t offset = _dma_buffer_offset + idx;
|
||||
_dma_buffer[offset] = (uint16_t)buffer->data[idx];
|
||||
}
|
||||
for (; idx < DMA_BUFFER_HALF_LEN; idx++) {
|
||||
uint32_t offset = _dma_buffer_offset + idx;
|
||||
_dma_buffer[offset] = 0;
|
||||
}
|
||||
audioQueue.buffersFifo.freeNextFilledBuffer();
|
||||
}
|
||||
}
|
||||
|
||||
void audioSetVolume(uint8_t volume)
|
||||
{
|
||||
tas2505_set_volume(&_tas2505, volume * 9 / 10); // TX15 HP cannot handle the full power of TAS2505
|
||||
}
|
||||
|
||||
extern "C" void DMA1_Stream4_IRQHandler(void)
|
||||
{
|
||||
if (stm32_dma_check_ht_flag(I2S_DMA, I2S_DMA_Stream)) {
|
||||
audio_update_dma_buffer(0);
|
||||
}
|
||||
|
||||
if (stm32_dma_check_tc_flag(I2S_DMA, I2S_DMA_Stream)) {
|
||||
audio_update_dma_buffer(1);
|
||||
}
|
||||
}
|
||||
Reference in New Issue
Block a user