|
|
@ -7,36 +7,38 @@ |
|
|
|
#include "driver/i2c.h" |
|
|
|
#include "driver/i2c.h" |
|
|
|
#include "driver/i2s_common.h" |
|
|
|
#include "driver/i2s_common.h" |
|
|
|
#include "driver/i2s_std.h" |
|
|
|
#include "driver/i2s_std.h" |
|
|
|
#include "driver/i2s_types.h" |
|
|
|
|
|
|
|
#include "esp_attr.h" |
|
|
|
#include "esp_attr.h" |
|
|
|
#include "esp_err.h" |
|
|
|
#include "esp_err.h" |
|
|
|
#include "esp_log.h" |
|
|
|
#include "esp_log.h" |
|
|
|
#include "freertos/portmacro.h" |
|
|
|
#include "freertos/portmacro.h" |
|
|
|
#include "freertos/projdefs.h" |
|
|
|
#include "freertos/projdefs.h" |
|
|
|
|
|
|
|
#include "hal/gpio_types.h" |
|
|
|
#include "hal/i2c_types.h" |
|
|
|
#include "hal/i2c_types.h" |
|
|
|
|
|
|
|
|
|
|
|
#include "gpio_expander.hpp" |
|
|
|
#include "gpio_expander.hpp" |
|
|
|
#include "hal/i2s_types.h" |
|
|
|
#include "hal/i2s_types.h" |
|
|
|
#include "i2c.hpp" |
|
|
|
#include "i2c.hpp" |
|
|
|
|
|
|
|
#include "soc/clk_tree_defs.h" |
|
|
|
#include "sys/_stdint.h" |
|
|
|
#include "sys/_stdint.h" |
|
|
|
|
|
|
|
|
|
|
|
namespace drivers { |
|
|
|
namespace drivers { |
|
|
|
|
|
|
|
|
|
|
|
static const char* kTag = "AUDIODAC"; |
|
|
|
static const char* kTag = "AUDIODAC"; |
|
|
|
static const uint8_t kPcm5122Address = 0x4C; |
|
|
|
static const uint8_t kPcm5122Address = 0x4C; |
|
|
|
static const uint8_t kPcm5122Timeout = pdMS_TO_TICKS(100); |
|
|
|
|
|
|
|
static const i2s_port_t kI2SPort = I2S_NUM_0; |
|
|
|
static const i2s_port_t kI2SPort = I2S_NUM_0; |
|
|
|
|
|
|
|
|
|
|
|
static const AudioDac::SampleRate kDefaultSampleRate = |
|
|
|
auto AudioDac::create(GpioExpander* expander) -> cpp::result<AudioDac*, Error> { |
|
|
|
AudioDac::SAMPLE_RATE_44_1; |
|
|
|
|
|
|
|
static const AudioDac::BitsPerSample kDefaultBps = AudioDac::BPS_16; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
auto AudioDac::create(GpioExpander* expander) |
|
|
|
|
|
|
|
-> cpp::result<std::unique_ptr<AudioDac>, Error> { |
|
|
|
|
|
|
|
// TODO: tune.
|
|
|
|
// TODO: tune.
|
|
|
|
i2s_chan_handle_t i2s_handle; |
|
|
|
i2s_chan_handle_t i2s_handle; |
|
|
|
i2s_chan_config_t channel_config = |
|
|
|
i2s_chan_config_t channel_config = |
|
|
|
I2S_CHANNEL_DEFAULT_CONFIG(kI2SPort, I2S_ROLE_MASTER); |
|
|
|
I2S_CHANNEL_DEFAULT_CONFIG(kI2SPort, I2S_ROLE_MASTER); |
|
|
|
|
|
|
|
// Use the maximum possible DMA buffer size, since a smaller number of large
|
|
|
|
|
|
|
|
// copies is faster than a large number of small copies.
|
|
|
|
|
|
|
|
channel_config.dma_frame_num = 1024; |
|
|
|
|
|
|
|
// Triple buffering should be enough to keep samples flowing smoothly.
|
|
|
|
|
|
|
|
// TODO(jacqueline): verify this with 192kHz 32bps.
|
|
|
|
|
|
|
|
channel_config.dma_desc_num = 4; |
|
|
|
|
|
|
|
// channel_config.auto_clear = true;
|
|
|
|
|
|
|
|
|
|
|
|
ESP_ERROR_CHECK(i2s_new_channel(&channel_config, &i2s_handle, NULL)); |
|
|
|
ESP_ERROR_CHECK(i2s_new_channel(&channel_config, &i2s_handle, NULL)); |
|
|
|
//
|
|
|
|
//
|
|
|
@ -50,9 +52,7 @@ auto AudioDac::create(GpioExpander* expander) |
|
|
|
i2s_std_config_t i2s_config = { |
|
|
|
i2s_std_config_t i2s_config = { |
|
|
|
.clk_cfg = dac->clock_config_, |
|
|
|
.clk_cfg = dac->clock_config_, |
|
|
|
.slot_cfg = dac->slot_config_, |
|
|
|
.slot_cfg = dac->slot_config_, |
|
|
|
.gpio_cfg = |
|
|
|
.gpio_cfg = {.mclk = GPIO_NUM_0, |
|
|
|
{// TODO: investigate running in three wire mode for less noise
|
|
|
|
|
|
|
|
.mclk = GPIO_NUM_0, |
|
|
|
|
|
|
|
.bclk = GPIO_NUM_26, |
|
|
|
.bclk = GPIO_NUM_26, |
|
|
|
.ws = GPIO_NUM_27, |
|
|
|
.ws = GPIO_NUM_27, |
|
|
|
.dout = GPIO_NUM_5, |
|
|
|
.dout = GPIO_NUM_5, |
|
|
@ -61,10 +61,13 @@ auto AudioDac::create(GpioExpander* expander) |
|
|
|
{ |
|
|
|
{ |
|
|
|
.mclk_inv = false, |
|
|
|
.mclk_inv = false, |
|
|
|
.bclk_inv = false, |
|
|
|
.bclk_inv = false, |
|
|
|
.ws_inv = false, |
|
|
|
.ws_inv = true, |
|
|
|
}}, |
|
|
|
}}, |
|
|
|
}; |
|
|
|
}; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// gpio_set_direction(GPIO_NUM_0, GPIO_MODE_OUTPUT);
|
|
|
|
|
|
|
|
// gpio_set_level(GPIO_NUM_0, 0);
|
|
|
|
|
|
|
|
|
|
|
|
if (esp_err_t err = |
|
|
|
if (esp_err_t err = |
|
|
|
i2s_channel_init_std_mode(i2s_handle, &i2s_config) != ESP_OK) { |
|
|
|
i2s_channel_init_std_mode(i2s_handle, &i2s_config) != ESP_OK) { |
|
|
|
ESP_LOGE(kTag, "failed to initialise i2s channel %x", err); |
|
|
|
ESP_LOGE(kTag, "failed to initialise i2s channel %x", err); |
|
|
@ -81,65 +84,64 @@ auto AudioDac::create(GpioExpander* expander) |
|
|
|
|
|
|
|
|
|
|
|
// The DAC should be booted but in power down mode, but it might not be if we
|
|
|
|
// The DAC should be booted but in power down mode, but it might not be if we
|
|
|
|
// didn't shut down cleanly. Reset it to ensure it is in a consistent state.
|
|
|
|
// didn't shut down cleanly. Reset it to ensure it is in a consistent state.
|
|
|
|
dac->WriteRegister(Register::POWER_MODE, 0b10001); |
|
|
|
dac->WriteRegister(pcm512x::POWER, 1 << 4); |
|
|
|
dac->WriteRegister(Register::POWER_MODE, 1 << 4); |
|
|
|
dac->WriteRegister(pcm512x::RESET, 0b10001); |
|
|
|
dac->WriteRegister(Register::RESET, 0b10001); |
|
|
|
|
|
|
|
|
|
|
|
// Use BCK for the internal PLL.
|
|
|
|
|
|
|
|
// dac->WriteRegister(Register::PLL_CLOCK_SOURCE, 1 << 4);
|
|
|
|
|
|
|
|
// dac->WriteRegister(Register::DAC_CLOCK_SOURCE, 0b11 << 5);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// dac->WriteRegister(Register::PLL_ENABLE, 0);
|
|
|
|
|
|
|
|
// dac->WriteRegister(Register::DAC_CLOCK_SOURCE, 0b0110000);
|
|
|
|
|
|
|
|
// dac->WriteRegister(Register::CLOCK_ERRORS, 0b01000001);
|
|
|
|
|
|
|
|
// dac->WriteRegister(Register::I2S_FORMAT, 0b110000);
|
|
|
|
|
|
|
|
// dac->WriteRegister(Register::INTERPOLATION, 1 << 4);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
dac->Reconfigure(BPS_16, SAMPLE_RATE_44_1); |
|
|
|
|
|
|
|
|
|
|
|
// Now configure the DAC for standard auto-clock SCK mode.
|
|
|
|
// Now configure the DAC for standard auto-clock SCK mode.
|
|
|
|
dac->WriteRegister(Register::DAC_CLOCK_SOURCE, 0b11 << 5); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Enable auto clocking, and do your best to carry on despite errors.
|
|
|
|
// Enable auto clocking, and do your best to carry on despite errors.
|
|
|
|
// dac->WriteRegister(Register::CLOCK_ERRORS, 0b1111101);
|
|
|
|
// dac->WriteRegister(Register::CLOCK_ERRORS, 0b1111101);
|
|
|
|
|
|
|
|
|
|
|
|
i2s_channel_enable(dac->i2s_handle_); |
|
|
|
// i2s_channel_enable(dac->i2s_handle_);
|
|
|
|
|
|
|
|
|
|
|
|
dac->WaitForPowerState( |
|
|
|
dac->WaitForPowerState([](bool booted, PowerState state) { |
|
|
|
[](bool booted, PowerState state) { return state == STANDBY; }); |
|
|
|
return state == RUN || state == STANDBY; |
|
|
|
|
|
|
|
}); |
|
|
|
|
|
|
|
|
|
|
|
return dac; |
|
|
|
return dac.release(); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
AudioDac::AudioDac(GpioExpander* gpio, i2s_chan_handle_t i2s_handle) |
|
|
|
AudioDac::AudioDac(GpioExpander* gpio, i2s_chan_handle_t i2s_handle) |
|
|
|
: gpio_(gpio), |
|
|
|
: gpio_(gpio), |
|
|
|
i2s_handle_(i2s_handle), |
|
|
|
i2s_handle_(i2s_handle), |
|
|
|
|
|
|
|
i2s_active_(false), |
|
|
|
|
|
|
|
active_page_(), |
|
|
|
clock_config_(I2S_STD_CLK_DEFAULT_CONFIG(44100)), |
|
|
|
clock_config_(I2S_STD_CLK_DEFAULT_CONFIG(44100)), |
|
|
|
slot_config_(I2S_STD_MSB_SLOT_DEFAULT_CONFIG(I2S_DATA_BIT_WIDTH_16BIT, |
|
|
|
slot_config_(I2S_STD_MSB_SLOT_DEFAULT_CONFIG(I2S_DATA_BIT_WIDTH_16BIT, |
|
|
|
I2S_SLOT_MODE_STEREO)) { |
|
|
|
I2S_SLOT_MODE_STEREO)) { |
|
|
|
gpio_->set_pin(GpioExpander::AUDIO_POWER_ENABLE, true); |
|
|
|
clock_config_.clk_src = I2S_CLK_SRC_PLL_160M; |
|
|
|
|
|
|
|
gpio_->set_pin(GpioExpander::AMP_EN, true); |
|
|
|
gpio_->Write(); |
|
|
|
gpio_->Write(); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
AudioDac::~AudioDac() { |
|
|
|
AudioDac::~AudioDac() { |
|
|
|
i2s_channel_disable(i2s_handle_); |
|
|
|
i2s_channel_disable(i2s_handle_); |
|
|
|
i2s_del_channel(i2s_handle_); |
|
|
|
i2s_del_channel(i2s_handle_); |
|
|
|
gpio_->set_pin(GpioExpander::AUDIO_POWER_ENABLE, false); |
|
|
|
gpio_->set_pin(GpioExpander::AMP_EN, false); |
|
|
|
gpio_->Write(); |
|
|
|
gpio_->Write(); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void AudioDac::WriteVolume(uint8_t volume) { |
|
|
|
void AudioDac::WriteVolume(uint8_t volume) { |
|
|
|
WriteRegister(Register::DIGITAL_VOLUME_L, volume); |
|
|
|
// Left channel.
|
|
|
|
WriteRegister(Register::DIGITAL_VOLUME_R, volume); |
|
|
|
WriteRegister(pcm512x::DIGITAL_VOLUME_2, volume); |
|
|
|
|
|
|
|
// Right channel.
|
|
|
|
|
|
|
|
WriteRegister(pcm512x::DIGITAL_VOLUME_3, volume); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
std::pair<bool, AudioDac::PowerState> AudioDac::ReadPowerState() { |
|
|
|
std::pair<bool, AudioDac::PowerState> AudioDac::ReadPowerState() { |
|
|
|
uint8_t result = 0; |
|
|
|
uint8_t result = ReadRegister(pcm512x::POWER_STATE); |
|
|
|
|
|
|
|
|
|
|
|
I2CTransaction transaction; |
|
|
|
|
|
|
|
transaction.start() |
|
|
|
|
|
|
|
.write_addr(kPcm5122Address, I2C_MASTER_WRITE) |
|
|
|
|
|
|
|
.write_ack(DSP_BOOT_POWER_STATE) |
|
|
|
|
|
|
|
.start() |
|
|
|
|
|
|
|
.write_addr(kPcm5122Address, I2C_MASTER_READ) |
|
|
|
|
|
|
|
.read(&result, I2C_MASTER_NACK) |
|
|
|
|
|
|
|
.stop(); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
esp_err_t err = transaction.Execute(); |
|
|
|
|
|
|
|
if (err == ESP_ERR_TIMEOUT) { |
|
|
|
|
|
|
|
return std::pair(false, POWERDOWN); |
|
|
|
|
|
|
|
} else { |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
ESP_ERROR_CHECK(err); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
bool is_booted = result >> 7; |
|
|
|
bool is_booted = result >> 7; |
|
|
|
PowerState detail = (PowerState)(result & 0b1111); |
|
|
|
PowerState detail = (PowerState)(result & 0b1111); |
|
|
|
return std::pair(is_booted, detail); |
|
|
|
return std::pair(is_booted, detail); |
|
|
@ -163,13 +165,29 @@ bool AudioDac::WaitForPowerState( |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
auto AudioDac::Reconfigure(BitsPerSample bps, SampleRate rate) -> void { |
|
|
|
auto AudioDac::Reconfigure(BitsPerSample bps, SampleRate rate) -> void { |
|
|
|
// Disable the current output, if it isn't already stopped.
|
|
|
|
if (i2s_active_) { |
|
|
|
WriteRegister(Register::POWER_MODE, 1 << 4); |
|
|
|
WriteRegister(pcm512x::MUTE, 0b10001); |
|
|
|
|
|
|
|
vTaskDelay(1); |
|
|
|
|
|
|
|
WriteRegister(pcm512x::POWER, 1 << 4); |
|
|
|
i2s_channel_disable(i2s_handle_); |
|
|
|
i2s_channel_disable(i2s_handle_); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
// I2S reconfiguration.
|
|
|
|
// I2S reconfiguration.
|
|
|
|
|
|
|
|
uint8_t bps_bits = 0; |
|
|
|
slot_config_.slot_bit_width = (i2s_slot_bit_width_t)bps; |
|
|
|
switch (bps) { |
|
|
|
|
|
|
|
case BPS_16: |
|
|
|
|
|
|
|
slot_config_.data_bit_width = I2S_DATA_BIT_WIDTH_16BIT; |
|
|
|
|
|
|
|
bps_bits = 0; |
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
case BPS_24: |
|
|
|
|
|
|
|
slot_config_.data_bit_width = I2S_DATA_BIT_WIDTH_24BIT; |
|
|
|
|
|
|
|
bps_bits = 0b10; |
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
case BPS_32: |
|
|
|
|
|
|
|
slot_config_.data_bit_width = I2S_DATA_BIT_WIDTH_32BIT; |
|
|
|
|
|
|
|
bps_bits = 0b11; |
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
} |
|
|
|
ESP_ERROR_CHECK(i2s_channel_reconfig_std_slot(i2s_handle_, &slot_config_)); |
|
|
|
ESP_ERROR_CHECK(i2s_channel_reconfig_std_slot(i2s_handle_, &slot_config_)); |
|
|
|
|
|
|
|
|
|
|
|
clock_config_.sample_rate_hz = rate; |
|
|
|
clock_config_.sample_rate_hz = rate; |
|
|
@ -181,30 +199,185 @@ auto AudioDac::Reconfigure(BitsPerSample bps, SampleRate rate) -> void { |
|
|
|
ESP_ERROR_CHECK(i2s_channel_reconfig_std_clock(i2s_handle_, &clock_config_)); |
|
|
|
ESP_ERROR_CHECK(i2s_channel_reconfig_std_clock(i2s_handle_, &clock_config_)); |
|
|
|
|
|
|
|
|
|
|
|
// DAC reconfiguration.
|
|
|
|
// DAC reconfiguration.
|
|
|
|
|
|
|
|
// Inspired heavily by https://github.com/tommag/PCM51xx_Arduino (MIT).
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Check that the bit clock (PLL input) is between 1MHz and 50MHz. It always
|
|
|
|
|
|
|
|
// should be.
|
|
|
|
|
|
|
|
uint32_t bckFreq = rate * bps * 2; |
|
|
|
|
|
|
|
if (bckFreq < 1000000 || bckFreq > 50000000) { |
|
|
|
|
|
|
|
ESP_LOGE(kTag, "bck freq out of range"); |
|
|
|
|
|
|
|
return; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// 24 bits is not supported for 44.1kHz and 48kHz.
|
|
|
|
|
|
|
|
if ((rate == SAMPLE_RATE_44_1 || rate == SAMPLE_RATE_48) && bps == BPS_24) { |
|
|
|
|
|
|
|
// TODO(jacqueline): I think this *can* be implemented, but requires a bunch
|
|
|
|
|
|
|
|
// of maths.
|
|
|
|
|
|
|
|
ESP_LOGE(kTag, "sample rate and bps mismatch"); |
|
|
|
|
|
|
|
return; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Initialize system clock from the I2S BCK input
|
|
|
|
|
|
|
|
// Disable clock autoset and ignore SCK detection
|
|
|
|
|
|
|
|
WriteRegister(pcm512x::ERROR_DETECT, 0x1A); |
|
|
|
|
|
|
|
// Set PLL clock source to BCK
|
|
|
|
|
|
|
|
WriteRegister(pcm512x::PLL_REF, 0x10); |
|
|
|
|
|
|
|
// Set DAC clock source to PLL output
|
|
|
|
|
|
|
|
WriteRegister(pcm512x::DAC_REF, 0x10); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// PLL configuration
|
|
|
|
|
|
|
|
int p, j, d, r; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Clock dividers
|
|
|
|
|
|
|
|
int nmac, ndac, ncp, dosr, idac; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (rate == SAMPLE_RATE_11_025 || rate == SAMPLE_RATE_22_05 || |
|
|
|
|
|
|
|
rate == SAMPLE_RATE_44_1) { |
|
|
|
|
|
|
|
// 44.1kHz and derivatives.
|
|
|
|
|
|
|
|
// P = 1, R = 2, D = 0 for all supported combinations.
|
|
|
|
|
|
|
|
// Set J to have PLL clk = 90.3168 MHz
|
|
|
|
|
|
|
|
p = 1; |
|
|
|
|
|
|
|
r = 2; |
|
|
|
|
|
|
|
j = 90316800 / bckFreq / r; |
|
|
|
|
|
|
|
d = 0; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Derive clocks from the 90.3168MHz PLL
|
|
|
|
|
|
|
|
nmac = 2; |
|
|
|
|
|
|
|
ndac = 16; |
|
|
|
|
|
|
|
ncp = 4; |
|
|
|
|
|
|
|
dosr = 8; |
|
|
|
|
|
|
|
idac = 1024; // DSP clock / sample rate
|
|
|
|
|
|
|
|
} else { |
|
|
|
|
|
|
|
// 8kHz and multiples.
|
|
|
|
|
|
|
|
// PLL config for a 98.304 MHz PLL clk
|
|
|
|
|
|
|
|
if (bps == BPS_24 && bckFreq > 1536000) { |
|
|
|
|
|
|
|
p = 3; |
|
|
|
|
|
|
|
} else if (bckFreq > 12288000) { |
|
|
|
|
|
|
|
p = 2; |
|
|
|
|
|
|
|
} else { |
|
|
|
|
|
|
|
p = 1; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
r = 2; |
|
|
|
|
|
|
|
j = 98304000 / (bckFreq / p) / r; |
|
|
|
|
|
|
|
d = 0; |
|
|
|
|
|
|
|
|
|
|
|
// TODO: base on BPS
|
|
|
|
// Derive clocks from the 98.304MHz PLL
|
|
|
|
WriteRegister(Register::I2S_FORMAT, 0); |
|
|
|
switch (rate) { |
|
|
|
|
|
|
|
case SAMPLE_RATE_16: |
|
|
|
|
|
|
|
nmac = 6; |
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
case SAMPLE_RATE_32: |
|
|
|
|
|
|
|
nmac = 3; |
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
default: |
|
|
|
|
|
|
|
nmac = 2; |
|
|
|
|
|
|
|
break; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
ndac = 16; |
|
|
|
|
|
|
|
ncp = 4; |
|
|
|
|
|
|
|
dosr = 384000 / rate; |
|
|
|
|
|
|
|
idac = 98304000 / nmac / rate; // DSP clock / sample rate
|
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Configure PLL
|
|
|
|
|
|
|
|
WriteRegister(pcm512x::PLL_COEFF_0, p - 1); |
|
|
|
|
|
|
|
WriteRegister(pcm512x::PLL_COEFF_1, j); |
|
|
|
|
|
|
|
WriteRegister(pcm512x::PLL_COEFF_2, (d >> 8) & 0x3F); |
|
|
|
|
|
|
|
WriteRegister(pcm512x::PLL_COEFF_3, d & 0xFF); |
|
|
|
|
|
|
|
WriteRegister(pcm512x::PLL_COEFF_4, r - 1); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// Clock dividers
|
|
|
|
|
|
|
|
WriteRegister(pcm512x::DSP_CLKDIV, nmac - 1); |
|
|
|
|
|
|
|
WriteRegister(pcm512x::DAC_CLKDIV, ndac - 1); |
|
|
|
|
|
|
|
WriteRegister(pcm512x::NCP_CLKDIV, ncp - 1); |
|
|
|
|
|
|
|
WriteRegister(pcm512x::OSR_CLKDIV, dosr - 1); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// IDAC (nb of DSP clock cycles per sample)
|
|
|
|
|
|
|
|
WriteRegister(pcm512x::IDAC_1, (idac >> 8) & 0xFF); |
|
|
|
|
|
|
|
WriteRegister(pcm512x::IDAC_2, idac & 0xFF); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
// FS speed mode
|
|
|
|
|
|
|
|
int speedMode; |
|
|
|
|
|
|
|
if (rate <= SAMPLE_RATE_48) { |
|
|
|
|
|
|
|
speedMode = 0; |
|
|
|
|
|
|
|
} else if (rate <= SAMPLE_RATE_96) { |
|
|
|
|
|
|
|
speedMode = 1; |
|
|
|
|
|
|
|
} else if (rate <= SAMPLE_RATE_192) { |
|
|
|
|
|
|
|
speedMode = 2; |
|
|
|
|
|
|
|
} else { |
|
|
|
|
|
|
|
speedMode = 3; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
WriteRegister(pcm512x::FS_SPEED_MODE, speedMode); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
WriteRegister(pcm512x::I2S_1, (0b11 << 4) | bps_bits); |
|
|
|
|
|
|
|
WriteRegister(pcm512x::I2S_2, 0); |
|
|
|
|
|
|
|
|
|
|
|
// Configuration is all done, so we can now bring the DAC and I2S stream back
|
|
|
|
// Configuration is all done, so we can now bring the DAC and I2S stream back
|
|
|
|
// up. I2S first, since otherwise the DAC will see that there's no clocks and
|
|
|
|
// up. I2S first, since otherwise the DAC will see that there's no clocks and
|
|
|
|
// shut itself down.
|
|
|
|
// shut itself down.
|
|
|
|
ESP_ERROR_CHECK(i2s_channel_enable(i2s_handle_)); |
|
|
|
ESP_ERROR_CHECK(i2s_channel_enable(i2s_handle_)); |
|
|
|
WriteRegister(Register::POWER_MODE, 0); |
|
|
|
WriteRegister(pcm512x::POWER, 0); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (i2s_active_) { |
|
|
|
|
|
|
|
vTaskDelay(1); |
|
|
|
|
|
|
|
WriteRegister(pcm512x::MUTE, 0); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
i2s_active_ = true; |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
auto AudioDac::WriteData(cpp::span<std::byte> data) -> std::size_t { |
|
|
|
auto AudioDac::WriteData(const cpp::span<const std::byte>& data) -> void { |
|
|
|
std::size_t bytes_written = 0; |
|
|
|
std::size_t bytes_written = 0; |
|
|
|
esp_err_t err = i2s_channel_write(i2s_handle_, data.data(), data.size_bytes(), |
|
|
|
esp_err_t err = i2s_channel_write(i2s_handle_, data.data(), data.size_bytes(), |
|
|
|
&bytes_written, 0); |
|
|
|
&bytes_written, portMAX_DELAY); |
|
|
|
if (err != ESP_ERR_TIMEOUT) { |
|
|
|
if (err != ESP_ERR_TIMEOUT) { |
|
|
|
ESP_ERROR_CHECK(err); |
|
|
|
ESP_ERROR_CHECK(err); |
|
|
|
} |
|
|
|
} |
|
|
|
return bytes_written; |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
extern "C" IRAM_ATTR auto callback(i2s_chan_handle_t handle, |
|
|
|
|
|
|
|
i2s_event_data_t* event, |
|
|
|
|
|
|
|
void* user_ctx) -> bool { |
|
|
|
|
|
|
|
if (event == nullptr || user_ctx == nullptr) { |
|
|
|
|
|
|
|
return false; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
if (event->data == nullptr || event->size == 0) { |
|
|
|
|
|
|
|
return false; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
uint8_t** buf = reinterpret_cast<uint8_t**>(event->data); |
|
|
|
|
|
|
|
StreamBufferHandle_t src = reinterpret_cast<StreamBufferHandle_t>(user_ctx); |
|
|
|
|
|
|
|
BaseType_t ret = false; |
|
|
|
|
|
|
|
std::size_t bytes_received = |
|
|
|
|
|
|
|
xStreamBufferReceiveFromISR(src, *buf, event->size, &ret); |
|
|
|
|
|
|
|
if (bytes_received < event->size) { |
|
|
|
|
|
|
|
memset(*buf + bytes_received, 0, event->size - bytes_received); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
return ret; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
auto AudioDac::SetSource(StreamBufferHandle_t buffer) -> void { |
|
|
|
|
|
|
|
if (i2s_active_) { |
|
|
|
|
|
|
|
ESP_ERROR_CHECK(i2s_channel_disable(i2s_handle_)); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
i2s_event_callbacks_t callbacks{ |
|
|
|
|
|
|
|
.on_recv = NULL, |
|
|
|
|
|
|
|
.on_recv_q_ovf = NULL, |
|
|
|
|
|
|
|
.on_sent = NULL, |
|
|
|
|
|
|
|
.on_send_q_ovf = NULL, |
|
|
|
|
|
|
|
}; |
|
|
|
|
|
|
|
if (buffer != nullptr) { |
|
|
|
|
|
|
|
callbacks.on_sent = &callback; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
i2s_channel_register_event_callback(i2s_handle_, &callbacks, buffer); |
|
|
|
|
|
|
|
if (i2s_active_) { |
|
|
|
|
|
|
|
ESP_ERROR_CHECK(i2s_channel_enable(i2s_handle_)); |
|
|
|
|
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
auto AudioDac::Stop() -> void { |
|
|
|
auto AudioDac::Stop() -> void { |
|
|
|
LogStatus(); |
|
|
|
LogStatus(); |
|
|
|
WriteRegister(Register::POWER_MODE, 1 << 4); |
|
|
|
WriteRegister(pcm512x::POWER, 1 << 4); |
|
|
|
i2s_channel_disable(i2s_handle_); |
|
|
|
i2s_channel_disable(i2s_handle_); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
@ -218,35 +391,47 @@ auto AudioDac::Stop() -> void { |
|
|
|
auto AudioDac::LogStatus() -> void { |
|
|
|
auto AudioDac::LogStatus() -> void { |
|
|
|
uint8_t res; |
|
|
|
uint8_t res; |
|
|
|
|
|
|
|
|
|
|
|
res = ReadRegister(Register::SAMPLE_RATE_DETECTION); |
|
|
|
res = ReadRegister(pcm512x::RATE_DET_1); |
|
|
|
ESP_LOGI(kTag, "detected sample rate (want 3): %u", (res >> 4) && 0b111); |
|
|
|
ESP_LOGI(kTag, "detected sample rate (want 3): %u", (res & 0b01110000) >> 4); |
|
|
|
ESP_LOGI(kTag, "detected SCK ratio (want 6): %u", res && 0b1111); |
|
|
|
ESP_LOGI(kTag, "detected SCK ratio (want 6): %u", res && 0b1111); |
|
|
|
|
|
|
|
|
|
|
|
res = ReadRegister(Register::BCK_DETECTION); |
|
|
|
res = ReadRegister(pcm512x::RATE_DET_3); |
|
|
|
ESP_LOGI(kTag, "detected BCK (want... 16? 32?): %u", res); |
|
|
|
ESP_LOGI(kTag, "detected BCK (want... 16? 32?): %u", res); |
|
|
|
|
|
|
|
|
|
|
|
res = ReadRegister(Register::CLOCK_ERROR_STATE); |
|
|
|
res = ReadRegister(pcm512x::RATE_DET_4); |
|
|
|
ESP_LOGI(kTag, "clock errors (want zeroes): "); |
|
|
|
ESP_LOGI(kTag, "clock errors (want zeroes): "); |
|
|
|
ESP_LOGI(kTag, BYTE_TO_BINARY_PATTERN, BYTE_TO_BINARY(res & 0b1111111)); |
|
|
|
ESP_LOGI(kTag, BYTE_TO_BINARY_PATTERN, BYTE_TO_BINARY(res & 0b1111111)); |
|
|
|
|
|
|
|
|
|
|
|
res = ReadRegister(Register::CLOCK_STATUS); |
|
|
|
res = ReadRegister(pcm512x::CLOCK_STATUS); |
|
|
|
ESP_LOGI(kTag, "clock status (want zeroes): "); |
|
|
|
ESP_LOGI(kTag, "clock status (want zeroes): "); |
|
|
|
ESP_LOGI(kTag, BYTE_TO_BINARY_PATTERN, BYTE_TO_BINARY(res & 0b10111)); |
|
|
|
ESP_LOGI(kTag, BYTE_TO_BINARY_PATTERN, BYTE_TO_BINARY(res & 0b10111)); |
|
|
|
|
|
|
|
|
|
|
|
res = ReadRegister(Register::AUTO_MUTE_STATE); |
|
|
|
res = ReadRegister(pcm512x::DIGITAL_MUTE_DET); |
|
|
|
ESP_LOGI(kTag, "automute status (want 3): %u", res & 0b11); |
|
|
|
ESP_LOGI(kTag, "automute status (want 0): %u", res & 0b10001); |
|
|
|
|
|
|
|
|
|
|
|
res = ReadRegister(Register::SOFT_MUTE_STATE); |
|
|
|
|
|
|
|
ESP_LOGI(kTag, "soft mute pin status (want 3): %u", res & 0b11); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
res = ReadRegister(Register::SAMPLE_RATE_STATE); |
|
|
|
|
|
|
|
ESP_LOGI(kTag, "detected sample speed mode (want 0): %u", res & 0b11); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
auto power = ReadPowerState(); |
|
|
|
auto power = ReadPowerState(); |
|
|
|
ESP_LOGI(kTag, "current power state (want 5): %u", power.second); |
|
|
|
ESP_LOGI(kTag, "current power state (want 5): %u", power.second); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
void AudioDac::WriteRegister(Register reg, uint8_t val) { |
|
|
|
void AudioDac::WriteRegister(pcm512x::Register r, uint8_t val) { |
|
|
|
|
|
|
|
SelectPage(r.page); |
|
|
|
|
|
|
|
WriteRegisterRaw(r.reg, val); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
uint8_t AudioDac::ReadRegister(pcm512x::Register r) { |
|
|
|
|
|
|
|
SelectPage(r.page); |
|
|
|
|
|
|
|
return ReadRegisterRaw(r.reg); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void AudioDac::SelectPage(uint8_t page) { |
|
|
|
|
|
|
|
if (active_page_ && active_page_ == page) { |
|
|
|
|
|
|
|
return; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
WriteRegisterRaw(0, page); |
|
|
|
|
|
|
|
active_page_ = page; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void AudioDac::WriteRegisterRaw(uint8_t reg, uint8_t val) { |
|
|
|
I2CTransaction transaction; |
|
|
|
I2CTransaction transaction; |
|
|
|
transaction.start() |
|
|
|
transaction.start() |
|
|
|
.write_addr(kPcm5122Address, I2C_MASTER_WRITE) |
|
|
|
.write_addr(kPcm5122Address, I2C_MASTER_WRITE) |
|
|
@ -256,7 +441,7 @@ void AudioDac::WriteRegister(Register reg, uint8_t val) { |
|
|
|
transaction.Execute(); |
|
|
|
transaction.Execute(); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
uint8_t AudioDac::ReadRegister(Register reg) { |
|
|
|
uint8_t AudioDac::ReadRegisterRaw(uint8_t reg) { |
|
|
|
uint8_t result = 0; |
|
|
|
uint8_t result = 0; |
|
|
|
I2CTransaction transaction; |
|
|
|
I2CTransaction transaction; |
|
|
|
transaction.start() |
|
|
|
transaction.start() |
|
|
|