rt-thread/bsp/nuvoton/libraries/nu_packages/AudioCodec/acodec_nau88l25.c

/**************************************************************************//**
*
* @copyright (C) 2019 Nuvoton Technology Corp. All rights reserved.
*
* SPDX-License-Identifier: Apache-2.0
*
* Change Logs:
* Date            Author       Notes
* 2020-1-16       Wayne        First version
*
******************************************************************************/

#include <rtconfig.h>

#if defined(NU_PKG_USING_NAU88L25)

#include <rtthread.h>
#include <rtdevice.h>

#include "acodec_nau88l25.h"
#include "drv_i2s.h"

#define DBG_ENABLE
#define DBG_LEVEL DBG_LOG
#define DBG_SECTION_NAME  "acodec.nau88l25"
#define DBG_COLOR
#include <rtdbg.h>

#define DEF_NAU88L25_ADDR    0x1A

static struct rt_i2c_bus_device *g_I2cBusDev = NULL;
S_NU_NAU88L25_CONFIG *g_psCodecConfig = NULL;

static rt_err_t nau88l25_init(void);
static rt_err_t nau88l25_reset(void);
static rt_err_t nau88l25_dsp_control(struct rt_audio_configure *config);
static rt_err_t nau88l25_mixer_control(rt_uint32_t ui32Units, rt_uint32_t ui32Value);
static rt_err_t nau88l25_mixer_query(rt_uint32_t ui32Units, rt_uint32_t *ui32Value);

nu_acodec_ops nu_acodec_ops_nau88l25 =
{
    .name = "NAU88L25",
    .role = NU_ACODEC_ROLE_MASTER,
    .config = { // Default settings.
        .samplerate = 48000,
        .channels = 2,
        .samplebits = 16
    },
    .nu_acodec_init = nau88l25_init,
    .nu_acodec_reset = nau88l25_reset,

    .nu_acodec_dsp_control = nau88l25_dsp_control,
    .nu_acodec_mixer_control = nau88l25_mixer_control,
    .nu_acodec_mixer_query = nau88l25_mixer_query
};

static void nau88l25_delay_ms(rt_uint32_t nms)
{
    rt_thread_mdelay(nms);
}

static int I2C_WriteNAU88L25(uint16_t u16addr, uint16_t u16data)
{
    struct rt_i2c_msg msg;
    char au8TxData[4];

    RT_ASSERT(g_I2cBusDev != NULL);

    au8TxData[0] = (uint8_t)((u16addr >> 8) & 0x00FF);   //addr [15:8]
    au8TxData[1] = (uint8_t)(u16addr & 0x00FF);          //addr [ 7:0]
    au8TxData[2] = (uint8_t)((u16data >> 8) & 0x00FF);   //data [15:8]
    au8TxData[3] = (uint8_t)(u16data & 0x00FF);          //data [ 7:0]

    msg.addr  = DEF_NAU88L25_ADDR;               /* Slave address */
    msg.flags = RT_I2C_WR;                       /* Write flag */
    msg.buf   = (rt_uint8_t *)&au8TxData[0];     /* Slave register address */
    msg.len   = sizeof(au8TxData);               /* Number of bytes sent */

    if (g_I2cBusDev && rt_i2c_transfer(g_I2cBusDev, &msg, 1) != 1)
    {
        rt_kprintf("[Failed] addr=%x, data=%d\n", u16addr, u16data);
        return -RT_ERROR;
    }

    return RT_EOK;
}

static int I2C_ReadNAU88L25(uint16_t u16addr, uint16_t *pu16data)
{
    struct rt_i2c_msg msgs[2];
    uint16_t u16data = 0;
    char au8TxData[2];

    RT_ASSERT(g_I2cBusDev != NULL);

    au8TxData[0] = (uint8_t)((u16addr >> 8) & 0x00FF);   //addr [15:8]
    au8TxData[1] = (uint8_t)(u16addr & 0x00FF);          //addr [ 7:0]

    msgs[0].addr  = DEF_NAU88L25_ADDR;        /* Slave address */
    msgs[0].flags = RT_I2C_WR;                /* Write flag */
    msgs[0].buf   = (rt_uint8_t *)&au8TxData; /* Number of bytes sent */
    msgs[0].len   = sizeof(au8TxData);        /* Number of bytes read */

    msgs[1].addr  = DEF_NAU88L25_ADDR;        /* Slave address */
    msgs[1].flags = RT_I2C_RD;                /* Read flag */
    msgs[1].buf   = (rt_uint8_t *)&u16data;   /* Read data pointer */
    msgs[1].len   = sizeof(u16data);          /* Number of bytes read */

    if (rt_i2c_transfer(g_I2cBusDev, &msgs[0], 2) != 2)
    {
        return -RT_ERROR;
    }

    return RT_EOK;
}

static void nau88l25_phonejack_set(S_NU_NAU88L25_CONFIG *psCodecConfig, int bEnable)
{
    rt_pin_mode(psCodecConfig->pin_phonejack_en, PIN_MODE_OUTPUT);

    if (bEnable)
    {
        rt_pin_write(psCodecConfig->pin_phonejack_en, PIN_LOW);
    }
    else
    {
        rt_pin_write(psCodecConfig->pin_phonejack_en, PIN_HIGH);
    }
}

static rt_err_t nau88l25_probe(void)
{
    return RT_EOK;
}

static rt_err_t nau88l25_reset(void)
{
    I2C_WriteNAU88L25(0,  0x1);
    I2C_WriteNAU88L25(0,  0);   // Reset all registers
    nau88l25_delay_ms(30);

    LOG_I("Software Reset.\n");

    return RT_EOK;
}

static rt_err_t nau88l25_dsp_config(rt_uint32_t ui32SamplRate, rt_uint8_t u8ChNum, rt_uint8_t u8SamplBit)
{
    int  clkDivider;
    int  i2sPcmCtrl2;
    int  lrClkDiv;
    char bClkDiv;
    char mClkDiv;

    /* Force to set Channel number to 2 */
    u8ChNum = 2;

    I2C_WriteNAU88L25(REG_I2S_PCM_CTRL1, AIFMT0_STANDI2S | ((u8SamplBit <= 24) ? ((u8SamplBit - 16) >> 2) : WLEN0_32BIT));
    u8SamplBit = (u8SamplBit > 16) ? 32 : 16;

    if (ui32SamplRate % 11025)
    {
        /* 48000 series 12.288Mhz */
        I2C_WriteNAU88L25(REG_FLL2, 0x3126);
        I2C_WriteNAU88L25(REG_FLL3, 0x0008);

        mClkDiv = 49152000 / (ui32SamplRate * 256);
    }
    else
    {
        /* 44100 series 11.2896Mhz */
        I2C_WriteNAU88L25(REG_FLL2, 0x86C2);
        I2C_WriteNAU88L25(REG_FLL3, 0x0007);

        /* FIXME */
        if (ui32SamplRate > 44100)
            ui32SamplRate = 11025;

        mClkDiv = 45158400 / (ui32SamplRate * 256);
    }

    lrClkDiv = u8ChNum * u8SamplBit;
    bClkDiv = 256 / lrClkDiv;

    switch (mClkDiv)
    {
    case 1:
        mClkDiv = 0;
        break;
    case 2:
        mClkDiv = 2;
        break;
    case 4:
        mClkDiv = 3;
        break;
    case 8:
        mClkDiv = 4;
        break;
    case 16:
        mClkDiv = 5;
        break;
    case 32:
        mClkDiv = 6;
        break;
    case 3:
        mClkDiv = 7;
        break;
    case 6:
        mClkDiv = 10;
        break;
    case 12:
        mClkDiv = 11;
        break;
    case 24:
        mClkDiv = 12;
        break;
    case 48:
        mClkDiv = 13;
        break;
    case 96:
        mClkDiv = 14;
        break;
    case 5:
        mClkDiv = 15;
        break;
    default:
        LOG_E("mclk divider not match!\n");
        mClkDiv = 0;
        return -RT_ERROR;
    }

    clkDivider = CLK_SYSCLK_SRC_VCO | CLK_ADC_SRC_DIV2 | CLK_DAC_SRC_DIV2 | mClkDiv;
    I2C_WriteNAU88L25(REG_CLK_DIVIDER, clkDivider);

    switch (bClkDiv)
    {
    case 2:
        bClkDiv = 0;
        break;
    case 4:
        bClkDiv = 1;
        break;
    case 8:
        bClkDiv = 2;
        break;
    case 16:
        bClkDiv = 3;
        break;
    case 32:
        bClkDiv = 4;
        break;
    case 64:
        bClkDiv = 5;
        break;
    default:
        LOG_E("bclk divider not match!\n");
        bClkDiv = 0;
        return -RT_ERROR;
    }

    switch (lrClkDiv)
    {
    case 256:
        lrClkDiv = 0;
        break;
    case 128:
        lrClkDiv = 1;
        break;
    case 64:
        lrClkDiv = 2;
        break;
    case 32:
        lrClkDiv = 3;
        break;
    default:
        LOG_E("lrclk divider not match!\n");
        lrClkDiv = 0;
        return -RT_ERROR;
    }

    i2sPcmCtrl2 =  ADCDAT0_OE | MS0_MASTER | (lrClkDiv << 12) | bClkDiv;

    I2C_WriteNAU88L25(REG_I2S_PCM_CTRL2, i2sPcmCtrl2);

    return RT_EOK;
}

static rt_err_t nau88l25_init(void)
{
    I2C_WriteNAU88L25(REG_CLK_DIVIDER,  CLK_SYSCLK_SRC_VCO | CLK_ADC_SRC_DIV2 | CLK_DAC_SRC_DIV2 | MCLK_SRC_DIV4);
    I2C_WriteNAU88L25(REG_FLL1,  FLL_RATIO_512K);
    I2C_WriteNAU88L25(REG_FLL2,  0x3126);
    I2C_WriteNAU88L25(REG_FLL3,  0x0008);
    I2C_WriteNAU88L25(REG_FLL4,  0x0010);
    I2C_WriteNAU88L25(REG_FLL5,  PDB_DACICTRL | CHB_FILTER_EN);
    I2C_WriteNAU88L25(REG_FLL6,  SDM_EN | CUTOFF500);
    I2C_WriteNAU88L25(REG_FLL_VCO_RSV,  0xF13C);
    I2C_WriteNAU88L25(REG_HSD_CTRL,  HSD_AUTO_MODE | MANU_ENGND1_GND);
    I2C_WriteNAU88L25(REG_SAR_CTRL,  RES_SEL_70K_OHMS | COMP_SPEED_1US | SAMPLE_SPEED_4US);
    I2C_WriteNAU88L25(REG_I2S_PCM_CTRL1,  AIFMT0_STANDI2S);

    if (nu_acodec_ops_nau88l25.role == NU_ACODEC_ROLE_MASTER)
    {
        I2C_WriteNAU88L25(REG_I2S_PCM_CTRL2,  LRC_DIV_DIV32 | ADCDAT0_OE | MS0_MASTER | BLCKDIV_DIV8);   //301A:Master 3012:Slave
    }
    else
    {
        I2C_WriteNAU88L25(REG_I2S_PCM_CTRL2,  LRC_DIV_DIV32 | ADCDAT0_OE | MS0_SLAVE | BLCKDIV_DIV8);
        I2C_WriteNAU88L25(REG_LEFT_TIME_SLOT,  DIS_FS_SHORT_DET);
    }

    I2C_WriteNAU88L25(REG_ADC_RATE,  0x10 | ADC_RATE_128);
    I2C_WriteNAU88L25(REG_DAC_CTRL1,  0x80 | DAC_RATE_128);

    I2C_WriteNAU88L25(REG_MUTE_CTRL,  0x0000); // 0x10000
    I2C_WriteNAU88L25(REG_ADC_DGAIN_CTRL,  DGAINL_ADC0(0xEF));
    I2C_WriteNAU88L25(REG_DACL_CTRL,  DGAINL_DAC(0xAE));
    I2C_WriteNAU88L25(REG_DACR_CTRL,  DGAINR_DAC(0xAE) | DAC_CH_SEL1_RIGHT);

    I2C_WriteNAU88L25(REG_CLASSG_CTRL,  CLASSG_TIMER_64MS | CLASSG_CMP_EN_R_DAC | CLASSG_CMP_EN_L_DAC | CLASSG_EN);
    I2C_WriteNAU88L25(REG_BIAS_ADJ,  VMIDEN | VMIDSEL_125K_OHM);
    I2C_WriteNAU88L25(REG_TRIM_SETTINGS,  DRV_IBCTRHS | DRV_ICUTHS | INTEG_IBCTRHS | INTEG_ICUTHS);
    I2C_WriteNAU88L25(REG_ANALOG_CONTROL_2,  AB_ADJ | CAP_1 | CAP_0);
    I2C_WriteNAU88L25(REG_ANALOG_ADC_1,  CHOPRESETN | CHOPF0_DIV4);
    I2C_WriteNAU88L25(REG_ANALOG_ADC_2,  VREFSEL_VMIDE_P5DB | PDNOTL | LFSRRESETN);
    I2C_WriteNAU88L25(REG_RDAC,  DAC_EN_L | DAC_EN_R | CLK_DAC_EN_L | CLK_DAC_EN_R | CLK_DAC_DELAY_2NSEC | DACVREFSEL(0x3));
    I2C_WriteNAU88L25(REG_MIC_BIAS,  INT2KB | LOWNOISE | POWERUP | MICBIASLVL1_1P1x);
    I2C_WriteNAU88L25(REG_BOOST,  PDVMDFST | BIASEN | BOOSTGDIS | EN_SHRT_SHTDWN);
    I2C_WriteNAU88L25(REG_POWER_UP_CONTROL,  PUFEPGA | FEPGA_GAIN(21) | PUP_INTEG_LEFT_HP | PUP_INTEG_RIGHT_HP | PUP_DRV_INSTG_RIGHT_HP | PUP_DRV_INSTG_LEFT_HP | PUP_MAIN_DRV_RIGHT_HP | PUP_MAIN_DRV_LEFT_HP);
    I2C_WriteNAU88L25(REG_CHARGE_PUMP_AND_DOWN_CONTROL, JAMNODCLOW | RNIN);
    I2C_WriteNAU88L25(REG_ENA_CTRL,  RDAC_EN | LDAC_EN | ADC_EN | DCLK_ADC_EN | DCLK_DAC_EN | CLK_I2S_EN | 0x4);

    nu_acodec_ops_nau88l25.config.samplerate = 48000;
    nu_acodec_ops_nau88l25.config.channels = 2;
    nu_acodec_ops_nau88l25.config.samplebits = 16;

    LOG_I("Initialized done.\n");

    return RT_EOK;
}

static rt_err_t nau88l25_dsp_control(struct rt_audio_configure *config)
{
    rt_err_t result = RT_EOK;

    RT_ASSERT(config != RT_NULL);

    if (rt_memcmp((void *)config, (void *)&nu_acodec_ops_nau88l25.config, sizeof(struct rt_audio_configure)) != 0)
    {
        if ((result = nau88l25_dsp_config(config->samplerate, config->channels, config->samplebits)) == RT_EOK)
            rt_memcpy((void *)&nu_acodec_ops_nau88l25.config, (void *)config, sizeof(struct rt_audio_configure)) ;
    }
    return result;
}

static rt_err_t nau88l25_mixer_control(rt_uint32_t ui32Units, rt_uint32_t ui32Value)
{
    switch (ui32Units)
    {
    case AUDIO_MIXER_MUTE:
        if (ui32Value)
        {
            I2C_WriteNAU88L25(REG_MUTE_CTRL,  SMUTE_EN);
            nau88l25_phonejack_set(g_psCodecConfig, 0);
        }
        else
        {
            I2C_WriteNAU88L25(REG_MUTE_CTRL,  0x0000);
            nau88l25_phonejack_set(g_psCodecConfig, 1);
        }
        break;

    case AUDIO_MIXER_VOLUME:
        I2C_WriteNAU88L25(REG_DACL_CTRL,  DGAINL_DAC(ui32Value * 2));
        I2C_WriteNAU88L25(REG_DACR_CTRL,  DGAINR_DAC(ui32Value * 2) | DAC_CH_SEL1_RIGHT);
        break;

    case AUDIO_MIXER_QUERY:
    case AUDIO_MIXER_BASS:
    case AUDIO_MIXER_MID:
    case AUDIO_MIXER_TREBLE:
    case AUDIO_MIXER_EQUALIZER:
    case AUDIO_MIXER_LINE:
    case AUDIO_MIXER_DIGITAL:
    case AUDIO_MIXER_MIC:
    case AUDIO_MIXER_VITURAL:
    case AUDIO_MIXER_EXTEND:
    default:
        return -RT_ERROR;
    }
    return RT_EOK;
}

static rt_err_t nau88l25_mixer_query(rt_uint32_t ui32Units, rt_uint32_t *pui32Value)
{
    RT_ASSERT(pui32Value != RT_NULL);
    rt_uint16_t u16RV = 0;

    switch (ui32Units)
    {
    case AUDIO_MIXER_QUERY:
        *pui32Value = AUDIO_MIXER_VOLUME | AUDIO_MIXER_MUTE;
        break;

    case AUDIO_MIXER_MUTE:
        I2C_ReadNAU88L25(REG_MUTE_CTRL, (uint16_t *)&u16RV);
        if (u16RV & SMUTE_EN)
            *pui32Value = 1;
        else
            *pui32Value = 0;
        break;

    case AUDIO_MIXER_VOLUME:
        I2C_ReadNAU88L25(REG_DACL_CTRL, (uint16_t *)&u16RV);
        *pui32Value = u16RV / 2;
        break;

    case AUDIO_MIXER_BASS:
    case AUDIO_MIXER_MID:
    case AUDIO_MIXER_TREBLE:
    case AUDIO_MIXER_EQUALIZER:
    case AUDIO_MIXER_LINE:
    case AUDIO_MIXER_DIGITAL:
    case AUDIO_MIXER_MIC:
    case AUDIO_MIXER_VITURAL:
    case AUDIO_MIXER_EXTEND:
    default:
        return -RT_ERROR;
    }
    return RT_EOK;
}

int nu_hw_nau88l25_init(S_NU_NAU88L25_CONFIG *psCodecConfig)
{
    RT_ASSERT(psCodecConfig != RT_NULL);
    struct rt_i2c_bus_device *psI2cBusDev;
    struct rt_audio_device *psAudioDev;
    nu_i2s_t psNuI2s;

    /* Find I2C bus */
    psI2cBusDev = (struct rt_i2c_bus_device *)rt_device_find(psCodecConfig->i2c_bus_name);
    if (psI2cBusDev == RT_NULL)
    {
        LOG_E("Can't found I2C bus - %s..!\n", psCodecConfig->i2c_bus_name);
        goto exit_rt_hw_nau88l25_init;
    }

    /* Find I2S bus */
    psAudioDev = (struct rt_audio_device *)rt_device_find(psCodecConfig->i2s_bus_name);
    if (psAudioDev == RT_NULL)
    {
        LOG_E("Can't found I2S bus - %s ..!\n", psCodecConfig->i2s_bus_name);
        goto exit_rt_hw_nau88l25_init;
    }

    if (nau88l25_probe() != RT_EOK)
    {
        LOG_E("Can't found audio codec..!\n");
        goto exit_rt_hw_nau88l25_init;
    }

    /* Store this board setting. */
    g_psCodecConfig = psCodecConfig;
    g_I2cBusDev = psI2cBusDev;

    /* Get NuI2S device instance. */
    psNuI2s = (nu_i2s_t)psAudioDev;

    /* Register Acodec Ops */
    psNuI2s->AcodecOps = &nu_acodec_ops_nau88l25;

    /* Use Acodec default settings. */
    rt_memcpy(&psNuI2s->config, &nu_acodec_ops_nau88l25.config, sizeof(struct rt_audio_configure));

    return RT_EOK;

exit_rt_hw_nau88l25_init:

    return -RT_ERROR;
}

#endif //#if defined(NU_PKG_USING_NAU88L25)