piotr/edgetx-gx12
1
0
Fork 0
Code Issues 2 Pull Requests Actions Packages Projects Releases Wiki Activity

feat(radio): WM8904 support

Browse Source
This commit is contained in:
raphaelcoeffic
2025-01-18 11:31:07 +01:00
committed by Malte Langermann
parent 9f8e2e313e
commit 1b0cde96ed
2 changed files with 322 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
radio/src/drivers/wm8904.cpp
+287
View File
@@ -0,0 +1,287 @@
/*
* Copyright (C) EdgeTX
*
* Based on code named
* opentx - https://github.com/opentx/opentx
* th9x - http://code.google.com/p/th9x
* er9x - http://code.google.com/p/er9x
* gruvin9x - http://code.google.com/p/gruvin9x
*
* License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*/
#include "wm8904.h"
#include "stm32_i2s.h"
#include "timers_driver.h"
#include "debug.h"
/* SW Reset */
#define WM8904_SW_RESET 0x0000U
/* Bias Control */
#define WM8904_BIAS_CONTROL0 0x0004U
#define WM8904_VMID_CONTROL0 0x0005U
#define WM8904_MIC_BIAS_CONTROL0 0x0006U
#define WM8904_MIC_BIAS_CONTROL1 0x0007U
#define WM8904_ANALOG_ADC0 0x000AU
/* Power Management */
#define WM8904_PWR_MANAGEMENT0 0x000CU
#define WM8904_PWR_MANAGEMENT2 0x000EU
#define WM8904_PWR_MANAGEMENT3 0x000FU
#define WM8904_PWR_MANAGEMENT6 0x0012U
/* Clock Rates */
#define WM8904_CLOCK_RATES0 0x0014U
#define WM8904_CLOCK_RATES1 0x0015U
#define WM8904_CLOCK_RATES2 0x0016U
/* Audio Interface */
#define WM8904_AUDIO_INTERFACE0 0x0018U
#define WM8904_AUDIO_INTERFACE1 0x0019U
#define WM8904_AUDIO_INTERFACE2 0x001AU
#define WM8904_AUDIO_INTERFACE3 0x001BU
/* DAC */
#define WM8904_DAC_DIGITAL_VOL_LEFT 0x001EU
#define WM8904_DAC_DIGITAL_VOL_RIGHT 0x001FU
#define WM8904_DAC_DIGITAL0 0x0020U
#define WM8904_DAC_DIGITAL1 0x0021U
/* ADC */
#define WM8904_ADC_DIGITAL_VOL_LEFT 0x0024U
#define WM8904_ADC_DIGITAL_VOL_RIGHT 0x0025U
#define WM8904_ADC_DIGITAL0 0x0026U
#define WM8904_DIGITAL_MICROPHONE0 0x0027U
/* DRC */
#define WM8904_DRC0 0x0028U
#define WM8904_DRC1 0x0029U
#define WM8904_DRC2 0x002AU
#define WM8904_DRC3 0x002BU
/* Analog */
#define WM8904_ANALOG_LEFT_INPUT0 0x002CU
#define WM8904_ANALOG_RIGHT_INPUT0 0x002DU
#define WM8904_ANALOG_LEFT_INPUT1 0x002EU
#define WM8904_ANALOG_RIGHT_INPUT1 0x002FU
#define WM8904_ANALOG_OUTPUT1_LEFT 0x0039U
#define WM8904_ANALOG_OUTPUT1_RIGHT 0x003AU
#define WM8904_ANALOG_OUTPUT2_LEFT 0x003BU
#define WM8904_ANALOG_OUTPUT2_RIGHT 0x003CU
#define WM8904_ANALOG_OUTPUT12_ZC 0x003DU
/* DC Servo */
#define WM8904_DC_SERVO0 0x0043U
#define WM8904_DC_SERVO1 0x0044U
#define WM8904_DC_SERVO2 0x0045U
#define WM8904_DC_SERVO4 0x0047U
#define WM8904_DC_SERVO5 0x0048U
#define WM8904_DC_SERVO6 0x0049U
#define WM8904_DC_SERVO7 0x004AU
#define WM8904_DC_SERVO8 0x004BU
#define WM8904_DC_SERVO9 0x004CU
#define WM8904_DC_SERVO_READBACK0 0x004DU
/* Analog */
#define WM8904_ANALOG_HP0 0x005AU
#define WM8904_ANALOG_LINEOUT0 0x005EU
/* Charge pump */
#define WM8904_CHARGE_PUMP0 0x0062U
/* Class W/G */
#define WM8904_CLASS_W0 0x0068U
/* Write Sequencer */
#define WM8904_WRITE_SEQUENCER0 0x006CU
#define WM8904_WRITE_SEQUENCER1 0x006DU
#define WM8904_WRITE_SEQUENCER2 0x006EU
#define WM8904_WRITE_SEQUENCER3 0x006FU
#define WM8904_WRITE_SEQUENCER4 0x0070U
/* FLL Control */
#define WM8904_FLL_CONTROL1 0x0074U
#define WM8904_FLL_CONTROL2 0x0075U
#define WM8904_FLL_CONTROL3 0x0076U
#define WM8904_FLL_CONTROL4 0x0077U
#define WM8904_FLL_CONTROL5 0x0078U
/* GPIO Control */
#define WM8904_GPIO_CONTROL1 0x0079U
#define WM8904_GPIO_CONTROL2 0x007AU
#define WM8904_GPIO_CONTROL3 0x007BU
#define WM8904_GPIO_CONTROL4 0x007CU
#define WM8904_DIGITAL_PULLS 0x007EU
/* Interrupt */
#define WM8904_INTERRUPT_STATUS 0x007FU
#define WM8904_INTERRUPT_STATUS_MASK 0x0080U
#define WM8904_INTERRUPT_POLARITY 0x0081U
#define WM8904_INTERRUPT_DEBOUNCE 0x0082U
/* EQ */
#define WM8904_EQ1 0x0086U
#define WM8904_EQ2 0x0087U
#define WM8904_EQ3 0x0088U
#define WM8904_EQ4 0x0089U
#define WM8904_EQ5 0x008AU
#define WM8904_EQ6 0x008BU
#define WM8904_EQ7 0x008CU
#define WM8904_EQ8 0x008DU
#define WM8904_EQ9 0x008EU
#define WM8904_EQ10 0x008FU
#define WM8904_EQ11 0x0090U
#define WM8904_EQ12 0x0091U
#define WM8904_EQ13 0x0092U
#define WM8904_EQ14 0x0093U
#define WM8904_EQ15 0x0094U
#define WM8904_EQ16 0x0095U
#define WM8904_EQ17 0x0096U
#define WM8904_EQ18 0x0097U
#define WM8904_EQ19 0x0098U
#define WM8904_EQ20 0x0099U
#define WM8904_EQ21 0x009AU
#define WM8904_EQ22 0x009BU
#define WM8904_EQ23 0x009CU
#define WM8904_EQ24 0x009DU
#define WM8904_ADC_TEST0 0x00C6U
#define WM8904_FLL_TEST0 0x00F7U
#define WM8904_FLL_TEST1 0x00F8U
static int wm8904_i2c_write(wm8904_t* dev, uint8_t reg, uint8_t* data, uint16_t length)
{
if (!dev->addr) return -1;
return i2c_write(dev->bus, dev->addr, reg, 1, data, length);
}
static int wm8904_i2c_read(wm8904_t* dev, uint8_t reg, uint8_t* data, uint16_t length)
{
if (!dev->addr) return -1;
return i2c_read(dev->bus, dev->addr, reg, 1, data, length);
}
int wm8904_write_reg(wm8904_t* dev, uint8_t reg, uint16_t value)
{
// swap bytes
uint16_t tmp;
tmp = ((uint16_t)(value >> 8) & 0x00FFU);
tmp |= ((uint16_t)(value << 8) & 0xFF00U);
return wm8904_i2c_write(dev, reg, (uint8_t*)&tmp, 2U);
}
int wm8904_read_reg(wm8904_t* dev, uint8_t reg, uint16_t* value)
{
uint16_t tmp;
int ret = wm8904_i2c_read(dev, reg, (uint8_t*)&tmp, 2U);
*value = ((uint16_t)(tmp >> 8) & 0x00FF);
*value |= ((uint16_t)(tmp << 8) & 0xFF00);
return ret;
}
int wm8904_probe(wm8904_t* dev, etx_i2c_bus_t bus, uint16_t addr)
{
dev->bus = 0;
dev->addr = 0;
if (i2c_init(bus) < 0) {
TRACE("WM8904 bus init error");
return -1;
}
if (i2c_dev_ready(bus, addr) < 0) {
TRACE("WM8904 device init error");
return -1;
}
dev->bus = bus;
dev->addr = addr;
uint16_t chip_id = 0;
if (wm8904_read_reg(dev, WM8904_SW_RESET, &chip_id) < 0) {
return -1;
}
return chip_id == 0x8904 ? 0 : -1;
}
static void wm8904_delay(uint32_t ms)
{
uint32_t start = timersGetMsTick();
while (timersGetMsTick() - start < ms) {}
}
int wm8904_init(wm8904_t* dev)
{
// software reset
if (wm8904_write_reg(dev, WM8904_SW_RESET, 1) < 0) return -1;
wm8904_delay(10);
uint16_t chip_id = 0;
if (wm8904_read_reg(dev, WM8904_SW_RESET, &chip_id) < 0) return -1;
TRACE("WM8904: ID = 0x%04x", chip_id);
#define WM8904_DELAY 0xFF00
const struct {
uint16_t reg;
uint16_t value;
} params[] = {
{WM8904_CLOCK_RATES2, 0x0004U}, // CLK_SYS_ENA = 1
{WM8904_BIAS_CONTROL0, 0x0018U},
{WM8904_VMID_CONTROL0, 0x0047U},
{WM8904_DELAY, 100}, // delay 100
{WM8904_VMID_CONTROL0, 0x0043U},
{WM8904_BIAS_CONTROL0, 0x0019U},
{WM8904_MIC_BIAS_CONTROL0, 0x0001U},
{WM8904_PWR_MANAGEMENT0, 0x0000U},
{WM8904_PWR_MANAGEMENT2, 0x0003U}, // HPL_PGA_ENA = HPR_PGA_ENA = 1
{WM8904_CLOCK_RATES2, 0x0006U}, // CLK_DSP_ENA = 1
{WM8904_PWR_MANAGEMENT6, 0x000CU}, // DACL_ENA = DACR_ENA = 1
{WM8904_DAC_DIGITAL1, 0x0640U}, // DAC_MUTERATE = DAC_UNMUTE_RAMP = OSR128 = 1
{WM8904_AUDIO_INTERFACE0, 0x0030U}, // AIFDACL_SRC = AIFDACR_SRC = 1
{WM8904_AUDIO_INTERFACE1, 0x0002U}, // 16B / I2S
{WM8904_CLOCK_RATES1, 0x0C04U}, // 32 kHz, ratio=256
{WM8904_ANALOG_OUTPUT1_LEFT, 0x003FU}, // Left vol 0 dB
{WM8904_ANALOG_OUTPUT2_RIGHT, 0x00BFU}, // Righ vol 0 dB + update
{WM8904_ADC_DIGITAL_VOL_LEFT, 0x0100U}, // ADC_VU = 1, ADC_VOL = Mute
{WM8904_CHARGE_PUMP0, 0x0001U},
{WM8904_ANALOG_HP0, 0x0011U},
{WM8904_ANALOG_HP0, 0x0033U},
{WM8904_DC_SERVO0, 0x0003U},
{WM8904_DC_SERVO1, 0x0030U},
{WM8904_DELAY, 300}, // delay 300
{WM8904_ANALOG_HP0, 0x0077U},
{WM8904_ANALOG_HP0, 0x00FFU},
{WM8904_CLASS_W0, 0x0001U},
};
for (unsigned i = 0; i < DIM(params); i++) {
uint16_t reg = params[i].reg;
uint8_t value = params[i].value;
if (reg == WM8904_DELAY) {
wm8904_delay(value);
} else if (wm8904_write_reg(dev, reg, value) < 0) {
return -1;
}
}
return 0;
}
radio/src/drivers/wm8904.h
+35
View File
@@ -0,0 +1,35 @@
/*
* Copyright (C) EdgeTX
*
* Based on code named
* opentx - https://github.com/opentx/opentx
* th9x - http://code.google.com/p/th9x
* er9x - http://code.google.com/p/er9x
* gruvin9x - http://code.google.com/p/gruvin9x
*
* License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 as
* published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*/
#pragma once
#include "hal/i2c_driver.h"
typedef struct {
etx_i2c_bus_t bus;
uint16_t addr;
} wm8904_t;
int wm8904_probe(wm8904_t* dev, etx_i2c_bus_t bus, uint16_t addr);
int wm8904_init(wm8904_t* dev);
int wm8904_write_reg(wm8904_t* dev, uint8_t reg, uint16_t data);
int wm8904_read_reg(wm8904_t* dev, uint8_t reg, uint16_t* value);