summaryrefslogtreecommitdiff
path: root/src/drivers/dac.cpp
diff options
context:
space:
mode:
Diffstat (limited to 'src/drivers/dac.cpp')
-rw-r--r--src/drivers/dac.cpp465
1 files changed, 0 insertions, 465 deletions
diff --git a/src/drivers/dac.cpp b/src/drivers/dac.cpp
deleted file mode 100644
index 3d8e0702..00000000
--- a/src/drivers/dac.cpp
+++ /dev/null
@@ -1,465 +0,0 @@
-/*
- * Copyright 2023 jacqueline <me@jacqueline.id.au>
- *
- * SPDX-License-Identifier: GPL-3.0-only
- */
-
-#include "dac.hpp"
-
-#include <cstdint>
-#include <cstring>
-
-#include "assert.h"
-#include "driver/i2c.h"
-#include "driver/i2s_common.h"
-#include "driver/i2s_std.h"
-#include "esp_attr.h"
-#include "esp_err.h"
-#include "esp_log.h"
-#include "freertos/portmacro.h"
-#include "freertos/projdefs.h"
-#include "hal/gpio_types.h"
-#include "hal/i2c_types.h"
-
-#include "gpio_expander.hpp"
-#include "hal/i2s_types.h"
-#include "i2c.hpp"
-#include "soc/clk_tree_defs.h"
-#include "sys/_stdint.h"
-
-namespace drivers {
-
-static const char* kTag = "AUDIODAC";
-static const uint8_t kPcm5122Address = 0x4C;
-static const i2s_port_t kI2SPort = I2S_NUM_0;
-
-auto AudioDac::create(GpioExpander* expander) -> cpp::result<AudioDac*, Error> {
- // TODO: tune.
- i2s_chan_handle_t i2s_handle;
- i2s_chan_config_t channel_config =
- 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));
- //
- // First, instantiate the instance so it can do all of its power on
- // configuration.
- std::unique_ptr<AudioDac> dac =
- std::make_unique<AudioDac>(expander, i2s_handle);
-
- // Whilst we wait for the initial boot, we can work on installing the I2S
- // driver.
- i2s_std_config_t i2s_config = {
- .clk_cfg = dac->clock_config_,
- .slot_cfg = dac->slot_config_,
- .gpio_cfg = {.mclk = GPIO_NUM_0,
- .bclk = GPIO_NUM_26,
- .ws = GPIO_NUM_27,
- .dout = GPIO_NUM_5,
- .din = I2S_GPIO_UNUSED,
- .invert_flags =
- {
- .mclk_inv = false,
- .bclk_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 =
- i2s_channel_init_std_mode(i2s_handle, &i2s_config) != ESP_OK) {
- ESP_LOGE(kTag, "failed to initialise i2s channel %x", err);
- return cpp::fail(Error::FAILED_TO_INSTALL_I2S);
- }
-
- // Make sure the DAC has booted before sending commands to it.
- bool is_booted = dac->WaitForPowerState(
- [](bool booted, PowerState state) { return booted; });
- if (!is_booted) {
- ESP_LOGE(kTag, "Timed out waiting for boot");
- return cpp::fail(Error::FAILED_TO_BOOT);
- }
-
- // 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.
- dac->WriteRegister(pcm512x::POWER, 1 << 4);
- dac->WriteRegister(pcm512x::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.
-
- // Enable auto clocking, and do your best to carry on despite errors.
- // dac->WriteRegister(Register::CLOCK_ERRORS, 0b1111101);
-
- // i2s_channel_enable(dac->i2s_handle_);
-
- dac->WaitForPowerState([](bool booted, PowerState state) {
- return state == RUN || state == STANDBY;
- });
-
- return dac.release();
-}
-
-AudioDac::AudioDac(GpioExpander* gpio, i2s_chan_handle_t i2s_handle)
- : gpio_(gpio),
- i2s_handle_(i2s_handle),
- i2s_active_(false),
- active_page_(),
- clock_config_(I2S_STD_CLK_DEFAULT_CONFIG(44100)),
- slot_config_(I2S_STD_MSB_SLOT_DEFAULT_CONFIG(I2S_DATA_BIT_WIDTH_16BIT,
- I2S_SLOT_MODE_STEREO)) {
- clock_config_.clk_src = I2S_CLK_SRC_PLL_160M;
- gpio_->set_pin(GpioExpander::AMP_EN, true);
- gpio_->Write();
-}
-
-AudioDac::~AudioDac() {
- i2s_channel_disable(i2s_handle_);
- i2s_del_channel(i2s_handle_);
- gpio_->set_pin(GpioExpander::AMP_EN, false);
- gpio_->Write();
-}
-
-void AudioDac::WriteVolume(uint8_t volume) {
- // Left channel.
- WriteRegister(pcm512x::DIGITAL_VOLUME_2, volume);
- // Right channel.
- WriteRegister(pcm512x::DIGITAL_VOLUME_3, volume);
-}
-
-std::pair<bool, AudioDac::PowerState> AudioDac::ReadPowerState() {
- uint8_t result = ReadRegister(pcm512x::POWER_STATE);
- bool is_booted = result >> 7;
- PowerState detail = (PowerState)(result & 0b1111);
- return std::pair(is_booted, detail);
-}
-
-bool AudioDac::WaitForPowerState(
- std::function<bool(bool, AudioDac::PowerState)> predicate) {
- bool has_matched = false;
- for (int i = 0; i < 10; i++) {
- std::pair<bool, PowerState> result = ReadPowerState();
- has_matched = predicate(result.first, result.second);
- if (has_matched) {
- break;
- } else {
- ESP_LOGI(kTag, "Waiting for power state (was %d 0x%x)", result.first,
- (uint8_t)result.second);
- vTaskDelay(pdMS_TO_TICKS(250));
- }
- }
- return has_matched;
-}
-
-auto AudioDac::Reconfigure(BitsPerSample bps, SampleRate rate) -> void {
- if (i2s_active_) {
- WriteRegister(pcm512x::MUTE, 0b10001);
- vTaskDelay(1);
- WriteRegister(pcm512x::POWER, 1 << 4);
- i2s_channel_disable(i2s_handle_);
- }
-
- // I2S reconfiguration.
- uint8_t bps_bits = 0;
- 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_));
-
- clock_config_.sample_rate_hz = rate;
- // If we have an MCLK/SCK, then it must be a multiple of both the sample rate
- // and the bit clock. At 24 BPS, we therefore have to change the MCLK multiple
- // to avoid issues at some sample rates. (e.g. 48KHz)
- clock_config_.mclk_multiple =
- bps == BPS_24 ? I2S_MCLK_MULTIPLE_384 : I2S_MCLK_MULTIPLE_256;
- ESP_ERROR_CHECK(i2s_channel_reconfig_std_clock(i2s_handle_, &clock_config_));
-
- // 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;
-
- // Derive clocks from the 98.304MHz PLL
- 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
- // up. I2S first, since otherwise the DAC will see that there's no clocks and
- // shut itself down.
- ESP_ERROR_CHECK(i2s_channel_enable(i2s_handle_));
- WriteRegister(pcm512x::POWER, 0);
-
- if (i2s_active_) {
- vTaskDelay(1);
- WriteRegister(pcm512x::MUTE, 0);
- }
- i2s_active_ = true;
-}
-
-auto AudioDac::WriteData(const cpp::span<const std::byte>& data) -> void {
- std::size_t bytes_written = 0;
- esp_err_t err = i2s_channel_write(i2s_handle_, data.data(), data.size_bytes(),
- &bytes_written, portMAX_DELAY);
- if (err != ESP_ERR_TIMEOUT) {
- ESP_ERROR_CHECK(err);
- }
-}
-
-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 {
- LogStatus();
- WriteRegister(pcm512x::POWER, 1 << 4);
- i2s_channel_disable(i2s_handle_);
-}
-
-#define BYTE_TO_BINARY_PATTERN "%c%c%c%c%c%c%c%c"
-#define BYTE_TO_BINARY(byte) \
- (byte & 0x80 ? '1' : '0'), (byte & 0x40 ? '1' : '0'), \
- (byte & 0x20 ? '1' : '0'), (byte & 0x10 ? '1' : '0'), \
- (byte & 0x08 ? '1' : '0'), (byte & 0x04 ? '1' : '0'), \
- (byte & 0x02 ? '1' : '0'), (byte & 0x01 ? '1' : '0')
-
-auto AudioDac::LogStatus() -> void {
- uint8_t res;
-
- res = ReadRegister(pcm512x::RATE_DET_1);
- ESP_LOGI(kTag, "detected sample rate (want 3): %u", (res & 0b01110000) >> 4);
- ESP_LOGI(kTag, "detected SCK ratio (want 6): %u", res && 0b1111);
-
- res = ReadRegister(pcm512x::RATE_DET_3);
- ESP_LOGI(kTag, "detected BCK (want... 16? 32?): %u", res);
-
- res = ReadRegister(pcm512x::RATE_DET_4);
- ESP_LOGI(kTag, "clock errors (want zeroes): ");
- ESP_LOGI(kTag, BYTE_TO_BINARY_PATTERN, BYTE_TO_BINARY(res & 0b1111111));
-
- res = ReadRegister(pcm512x::CLOCK_STATUS);
- ESP_LOGI(kTag, "clock status (want zeroes): ");
- ESP_LOGI(kTag, BYTE_TO_BINARY_PATTERN, BYTE_TO_BINARY(res & 0b10111));
-
- res = ReadRegister(pcm512x::DIGITAL_MUTE_DET);
- ESP_LOGI(kTag, "automute status (want 0): %u", res & 0b10001);
-
- auto power = ReadPowerState();
- ESP_LOGI(kTag, "current power state (want 5): %u", power.second);
-}
-
-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;
- transaction.start()
- .write_addr(kPcm5122Address, I2C_MASTER_WRITE)
- .write_ack(reg, val)
- .stop();
- // TODO: Retry once?
- transaction.Execute();
-}
-
-uint8_t AudioDac::ReadRegisterRaw(uint8_t reg) {
- uint8_t result = 0;
- I2CTransaction transaction;
- transaction.start()
- .write_addr(kPcm5122Address, I2C_MASTER_WRITE)
- .write_ack(reg)
- .start()
- .write_addr(kPcm5122Address, I2C_MASTER_READ)
- .read(&result, I2C_MASTER_NACK)
- .stop();
-
- transaction.Execute();
- return result;
-}
-
-} // namespace drivers