123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424 |
- #include "error.h"
- #include "ap_cp.h"
- #include "common.h"
- #include "gpio.h"
- #include "pwrmgr.h"
- #include "clock.h"
- #include "adc.h"
- #include <string.h>
- #include "log.h"
- #include "voice.h"
- static voice_Ctx_t mVoiceCtx;
- static uint32_t voice_data[HALF_VOICE_WORD_SIZE];
- void hal_voice_enable(void)
- {
- clk_gate_enable(MOD_ADCC);
- subWriteReg(0x40050000,0,0,1);
- }
- void hal_voice_disable(void)
- {
- clk_gate_disable(MOD_ADCC);
- subWriteReg(0x40050000,0,0,0);
- }
- void hal_voice_dmic_mode(void)
- {
- subWriteReg(0x4005000c,0,0,1);
- }
- void hal_voice_amic_mode(void)
- {
- subWriteReg(0x4005000c,0,0,0);
- subWriteReg(0x4000f048,7,5,0);
- subWriteReg(0x4000f07c,4,4,1);
- subWriteReg(0x4000f07c,0,0,1);
- subWriteReg(0x4000F000 + 0x7c,2,1,HAL_ADC_CLOCK_320K);
- }
- void hal_voice_dmic_open(GPIO_Pin_e dmicDataPin, GPIO_Pin_e dmicClkPin)
- {
- hal_gpio_fmux_set(dmicDataPin, (Fmux_Type_e)ADCC);
- hal_gpio_fmux_set(dmicClkPin, (Fmux_Type_e)CLK1P28M);
- }
- void hal_voice_amic_gain(uint8_t amicGain)
- {
- uint8_t pgaGain1;
- uint8_t pgaGain2;
-
- if (amicGain > 14)
- amicGain = 14;
-
- if (amicGain > 8) {
- pgaGain1 = 2;
- pgaGain2 = amicGain - 8;
- }
- else if (amicGain > 4) {
- pgaGain1 = 1;
- pgaGain2 = amicGain - 4;
- }
- else {
- pgaGain1 = 0;
- pgaGain2 = amicGain;
- }
- subWriteReg(0x4000f048,18,17,(uint32_t)pgaGain1);
- subWriteReg(0x4000f048,21,19,(uint32_t)pgaGain2);
- }
- void hal_voice_gain(uint8_t voiceGain)
- {
- subWriteReg(0x4005000c,22,16,(uint32_t)voiceGain);
- }
- void hal_voice_encode(VOICE_ENCODE_t voiceEncodeMode)
- {
- subWriteReg(0x4005000c,13,12,voiceEncodeMode);
- }
- void hal_voice_rate(VOICE_RATE_t voiceRate)
- {
- subWriteReg(0x4005000c,9,8,voiceRate);
- }
- static void set_voice_notch(VOICE_NOTCH_t voiceNotch)
- {
- subWriteReg(0x4005000c,3,2,voiceNotch);
- }
- static void set_voice_polarity(VOICE_POLARITY_t voicePolarity)
- {
- subWriteReg(0x4005000c,1,1,voicePolarity);
- }
- void hal_voice_amute_on(void)
- {
- subWriteReg(0x40050014,0,0,0);
- }
- void hal_voice_amute_off(void)
- {
- subWriteReg(0x40050014,0,0,1);
- }
- static void set_voice_amute_cfg(
- uint16_t amutGainMax,
- uint8_t amutGainBwMax,
- uint8_t amutGdut,
- uint8_t amutGst2,
- uint8_t amutGst1,
- uint16_t amutLvl2,
- uint16_t amutLvl1,
- uint8_t amutAlvl,
- uint8_t amutBeta,
- uint8_t amutWinl)
- {
- subWriteReg(0x40050010,30,20,(uint32_t)amutGainMax);
- subWriteReg(0x40050010,19,16,(uint32_t)amutGainBwMax);
- subWriteReg(0x40050010,13,8,(uint32_t)amutGdut);
- subWriteReg(0x40050010,7,4,(uint32_t)amutGst2);
- subWriteReg(0x40050010,3,0,(uint32_t)amutGst1);
- subWriteReg(0x40050014,30,20,(uint32_t)amutLvl2);
- subWriteReg(0x40050014,18,8,(uint32_t)amutLvl1);
- subWriteReg(0x40050018,15,8,(uint32_t)amutAlvl);
- subWriteReg(0x40050018,6,4,(uint32_t)amutBeta);
- subWriteReg(0x40050018,3,0,(uint32_t)amutWinl);
- }
- void __attribute__((used)) hal_ADC_IRQHandler(void)
- {
-
- MASK_VOICE_INT;
-
- if (GET_IRQ_STATUS & BIT(8)) {
- int n;
- for (n = 0; n < HALF_VOICE_WORD_SIZE; n++) {
- voice_data[n] = (uint32_t)(read_reg(VOICE_BASE + n * 4));
- }
- CLEAR_VOICE_HALF_INT;
- while (IS_CLAER_VOICE_HALF_INT) {}
- if (mVoiceCtx.evt_handler) {
- voice_Evt_t evt;
- evt.type = HAL_VOICE_EVT_DATA;
- evt.data = voice_data;
- evt.size = HALF_VOICE_WORD_SIZE;
- mVoiceCtx.evt_handler(&evt);
- }
- }
- else if (GET_IRQ_STATUS & BIT(9)) {
- int n;
- for (n = 0; n < HALF_VOICE_WORD_SIZE; n++) {
- voice_data[n] = (uint32_t)(read_reg(VOICE_MID_BASE + n * 4));
- }
- CLEAR_VOICE_FULL_INT;
- while (IS_CLAER_VOICE_FULL_INT) {}
- if (mVoiceCtx.evt_handler) {
- voice_Evt_t evt;
- evt.type = HAL_VOICE_EVT_DATA;
- evt.data = voice_data;
- evt.size = HALF_VOICE_WORD_SIZE;
- mVoiceCtx.evt_handler(&evt);
- }
- }
-
- ENABLE_VOICE_INT;
- }
- void hal_voice_init(void) {
- hal_pwrmgr_register(MOD_ADCC,NULL,NULL);
- hal_pwrmgr_register(MOD_VOC,NULL,NULL);
- memset(&mVoiceCtx, 0, sizeof(mVoiceCtx));;
- }
- int hal_voice_config(voice_Cfg_t cfg, voice_Hdl_t evt_handler)
- {
- if(mVoiceCtx.enable)
- return PPlus_ERR_BUSY;
-
- if(evt_handler == NULL)
- return PPlus_ERR_INVALID_PARAM;
-
- clk_gate_enable(MOD_ADCC);
- mVoiceCtx.evt_handler = evt_handler;
-
-
- if(cfg.voiceSelAmicDmic) {
- hal_voice_dmic_mode();
- hal_voice_dmic_open(cfg.dmicDataPin, cfg.dmicClkPin);
- }
- else {
- hal_voice_amic_mode();
- hal_voice_amic_gain(cfg.amicGain);
- }
-
- hal_voice_gain(cfg.voiceGain);
- hal_voice_encode(cfg.voiceEncodeMode);
- hal_voice_rate(cfg.voiceRate);
-
- set_voice_notch(VOICE_NOTCH_1);
- set_voice_polarity(VOICE_POLARITY_POS);
-
- if(cfg.voiceAutoMuteOnOff) {
- hal_voice_amute_off();
- }
- else {
- hal_voice_amute_on();
- }
-
- set_voice_amute_cfg(64, 6, 9, 0, 1, 55, 10, 48, 3, 10);
-
- mVoiceCtx.cfg = cfg;
-
-
-
-
- AP_PCRM->CLKSEL |= BIT(6);
-
-
- AP_PCRM->CLKHF_CTL0 |= BIT(18);
-
-
- AP_PCRM->CLKHF_CTL1 |= BIT(7);
-
-
- AP_PCRM->CLKHF_CTL1 &= ~BIT(21);
-
-
- AP_PCRM->CLKHF_CTL1 |= BIT(13);
-
- AP_PCRM->ADC_CTL4 |= BIT(4);
-
-
-
-
-
- return PPlus_SUCCESS;
- }
- int hal_voice_start(void)
- {
- clk_gate_enable(MOD_ADCC);
-
- mVoiceCtx.enable = TRUE;
- hal_pwrmgr_lock(MOD_ADCC);
- hal_pwrmgr_lock(MOD_VOC);
-
- if (mVoiceCtx.cfg.voiceSelAmicDmic) {
- }
- else {
- AP_PCRM->ANA_CTL |= BIT(16);
- AP_PCRM->ANA_CTL |= BIT(3);
- }
- NVIC_SetPriority((IRQn_Type)ADCC_IRQ, IRQ_PRIO_HAL);
-
- NVIC_EnableIRQ((IRQn_Type)ADCC_IRQ);
-
-
-
- hal_voice_enable();
-
-
- ENABLE_VOICE_INT;
-
- return PPlus_SUCCESS;
- }
- int hal_voice_stop(void)
- {
- MASK_VOICE_INT;
-
-
- hal_voice_disable();
-
- if (mVoiceCtx.cfg.voiceSelAmicDmic) {
- }
- else {
- AP_PCRM->ANA_CTL &= ~BIT(16);
- }
-
-
- hal_pwrmgr_unlock(MOD_VOC);
- hal_pwrmgr_unlock(MOD_ADCC);
- mVoiceCtx.enable = FALSE;
-
- return 0;
- }
- int hal_voice_clear(void)
- {
-
- MASK_VOICE_INT;
-
- NVIC_DisableIRQ((IRQn_Type)ADCC_IRQ);
-
- if (mVoiceCtx.cfg.voiceSelAmicDmic) {
- hal_gpioin_disable(mVoiceCtx.cfg.dmicDataPin);
- hal_gpioin_disable(mVoiceCtx.cfg.dmicClkPin);
- }
- else {
- }
-
-
- memset(&mVoiceCtx, 0, sizeof(mVoiceCtx));
-
-
- hal_pwrmgr_unlock(MOD_VOC);
-
- return 0;
- }
|