329 lines
10 KiB
C
329 lines
10 KiB
C
/***************************************************************************
|
|
* __________ __ ___.
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
* \/ \/ \/ \/ \/
|
|
* $Id$
|
|
*
|
|
* Driver for WM8758 audio codec - based on datasheet for WM8983
|
|
*
|
|
* Based on code from the ipodlinux project - http://ipodlinux.org/
|
|
* Adapted for Rockbox in December 2005
|
|
*
|
|
* Original file: linux/arch/armnommu/mach-ipod/audio.c
|
|
*
|
|
* Copyright (c) 2003-2005 Bernard Leach (leachbj@bouncycastle.org)
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version 2
|
|
* of the License, or (at your option) any later version.
|
|
*
|
|
* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
|
* KIND, either express or implied.
|
|
*
|
|
****************************************************************************/
|
|
|
|
#include "system.h"
|
|
#include "kernel.h"
|
|
#include "string.h"
|
|
#include "audio.h"
|
|
|
|
#include "wmcodec.h"
|
|
#include "audiohw.h"
|
|
#include "sound.h"
|
|
|
|
/* shadow registers */
|
|
static unsigned short eq1_reg = EQ1_EQ3DMODE | EQ_GAIN_VALUE(0);
|
|
static unsigned short eq5_reg = EQ_GAIN_VALUE(0);
|
|
|
|
/* convert tenth of dB volume (-89..6) to master volume register value */
|
|
static int vol_tenthdb2hw(int db)
|
|
{
|
|
/* att DAC AMP result
|
|
+6dB 0 +6 96
|
|
0dB 0 0 90
|
|
-57dB 0 -57 33
|
|
-58dB -1 -57 32
|
|
-89dB -32 -57 1
|
|
-90dB -oo -oo 0 */
|
|
if (db <= -900) {
|
|
return 0;
|
|
} else {
|
|
return db / 10 - -90;
|
|
}
|
|
}
|
|
|
|
/* helper function that calculates the register setting for amplifier and
|
|
DAC volume out of the input from tenthdb2master() */
|
|
static void get_volume_params(int db, int *dac, int *amp)
|
|
{
|
|
/* should never happen, set max volume for amp and dac */
|
|
if (db > 96) {
|
|
*dac = 255;
|
|
*amp = 63;
|
|
}
|
|
/* set dac to max and set volume for amp (better snr) */
|
|
else if (db > 32) {
|
|
*dac = 255;
|
|
*amp = (db-90)+57;
|
|
}
|
|
/* set amp to min and reduce dac output */
|
|
else if (db > 0) {
|
|
*dac = (db-33)*2 + 255;
|
|
*amp = 0;
|
|
}
|
|
/* mute all */
|
|
else {
|
|
*dac = 0x00;
|
|
*amp = 0x40;
|
|
}
|
|
}
|
|
|
|
static void audiohw_mute(bool mute)
|
|
{
|
|
if (mute) {
|
|
wmcodec_write(DACCTRL, DACCTRL_SOFTMUTE);
|
|
} else {
|
|
wmcodec_write(DACCTRL, DACCTRL_DACOSR128);
|
|
}
|
|
}
|
|
|
|
void audiohw_preinit(void)
|
|
{
|
|
/* Set low bias mode */
|
|
wmcodec_write(BIASCTRL, BIASCTRL_BIASCUT);
|
|
/* Enable HPCOM, LINECOM */
|
|
wmcodec_write(OUTCTRL, OUTCTRL_HP_COM | OUTCTRL_LINE_COM
|
|
| OUTCTRL_TSOPCTRL | OUTCTRL_TSDEN | OUTCTRL_VROI);
|
|
/* Mute all Outputs and set PGAs minimum gain */
|
|
wmcodec_write(LOUT1VOL, 0x140);
|
|
wmcodec_write(ROUT1VOL, 0x140);
|
|
wmcodec_write(LOUT2VOL, 0x140);
|
|
wmcodec_write(ROUT2VOL, 0x140);
|
|
wmcodec_write(OUT3MIX, 0x40);
|
|
wmcodec_write(OUT4MIX, 0x40);
|
|
/* Enable L/ROUT1 */
|
|
wmcodec_write(PWRMGMT2, PWRMGMT2_ROUT1EN | PWRMGMT2_LOUT1EN);
|
|
/* Enable VMID independent current bias */
|
|
wmcodec_write(OUT4TOADC, OUT4TOADC_POBCTRL);
|
|
/* Enable required DACs and mixers */
|
|
wmcodec_write(PWRMGMT3, PWRMGMT3_RMIXEN | PWRMGMT3_LMIXEN
|
|
| PWRMGMT3_DACENR | PWRMGMT3_DACENL);
|
|
/* Enable VMIDSEL, BIASEN, BUFIOEN */
|
|
wmcodec_write(PWRMGMT1, PWRMGMT1_PLLEN | PWRMGMT1_BIASEN
|
|
| PWRMGMT1_BUFIOEN | PWRMGMT1_VMIDSEL_10K);
|
|
/* Setup digital interface, input amplifiers, PLL, ADCs and DACs */
|
|
wmcodec_write(AINTFCE, AINTFCE_IWL_16BIT | AINTFCE_FORMAT_I2S);
|
|
wmcodec_write(CLKCTRL, CLKCTRL_MS); /* WM8758 is clock master */
|
|
|
|
audiohw_set_frequency(HW_FREQ_44);
|
|
|
|
wmcodec_write(LOUTMIX, LOUTMIX_DACL2LMIX);
|
|
wmcodec_write(ROUTMIX, ROUTMIX_DACR2RMIX);
|
|
/* Disable VMID independent current bias */
|
|
wmcodec_write(OUT4TOADC, 0);
|
|
}
|
|
|
|
void audiohw_postinit(void)
|
|
{
|
|
wmcodec_write(PWRMGMT1, PWRMGMT1_PLLEN | PWRMGMT1_BIASEN
|
|
| PWRMGMT1_BUFIOEN | PWRMGMT1_VMIDSEL_500K);
|
|
/* lower the VMID power consumption */
|
|
wmcodec_write(BIASCTRL, 0);
|
|
audiohw_mute(false);
|
|
}
|
|
|
|
void audiohw_set_volume(int vol_l, int vol_r)
|
|
{
|
|
int dac_l, amp_l, dac_r, amp_r;
|
|
|
|
vol_l = vol_tenthdb2hw(vol_l);
|
|
vol_r = vol_tenthdb2hw(vol_r);
|
|
|
|
get_volume_params(vol_l, &dac_l, &_l);
|
|
get_volume_params(vol_r, &dac_r, &_r);
|
|
|
|
/* set DAC
|
|
Important: DAC is global and will also affect lineout */
|
|
wmcodec_write(LDACVOL, dac_l);
|
|
wmcodec_write(RDACVOL, dac_r | RDACVOL_DACVU);
|
|
|
|
/* set headphone amp OUT1 */
|
|
wmcodec_write(LOUT1VOL, amp_l | LOUT1VOL_LOUT1ZC);
|
|
wmcodec_write(ROUT1VOL, amp_r | ROUT1VOL_ROUT1ZC | ROUT1VOL_OUT1VU);
|
|
}
|
|
|
|
void audiohw_set_lineout_volume(int vol_l, int vol_r)
|
|
{
|
|
int dac_l, amp_l, dac_r, amp_r;
|
|
|
|
vol_l = vol_tenthdb2hw(vol_l);
|
|
vol_r = vol_tenthdb2hw(vol_r);
|
|
|
|
get_volume_params(vol_l, &dac_l, &_l);
|
|
get_volume_params(vol_r, &dac_r, &_r);
|
|
|
|
/* set lineout amp OUT2 */
|
|
wmcodec_write(LOUT2VOL, amp_l | LOUT2VOL_LOUT2ZC);
|
|
wmcodec_write(ROUT2VOL, amp_r | ROUT2VOL_ROUT2ZC | ROUT2VOL_OUT2VU);
|
|
}
|
|
|
|
void audiohw_enable_lineout(bool enable)
|
|
{
|
|
/* Initialize data without lineout enabling. */
|
|
int pwrmgmt3_data = PWRMGMT3_RMIXEN | PWRMGMT3_LMIXEN
|
|
| PWRMGMT3_DACENR | PWRMGMT3_DACENL;
|
|
/* Set lineout (OUT2), if enabled. */
|
|
if (enable)
|
|
pwrmgmt3_data |= PWRMGMT3_LOUT2EN | PWRMGMT3_ROUT2EN;
|
|
|
|
/* Set register. */
|
|
wmcodec_write(PWRMGMT3, pwrmgmt3_data);
|
|
}
|
|
|
|
void audiohw_set_bass(int value)
|
|
{
|
|
eq1_reg = (eq1_reg & ~EQ_GAIN_MASK) | EQ_GAIN_VALUE(value);
|
|
wmcodec_write(EQ1, eq1_reg);
|
|
}
|
|
|
|
void audiohw_set_bass_cutoff(int value)
|
|
{
|
|
eq1_reg = (eq1_reg & ~EQ_CUTOFF_MASK) | EQ_CUTOFF_VALUE(value);
|
|
wmcodec_write(EQ1, eq1_reg);
|
|
}
|
|
|
|
void audiohw_set_treble(int value)
|
|
{
|
|
eq5_reg = (eq5_reg & ~EQ_GAIN_MASK) | EQ_GAIN_VALUE(value);
|
|
wmcodec_write(EQ5, eq5_reg);
|
|
}
|
|
|
|
void audiohw_set_treble_cutoff(int value)
|
|
{
|
|
eq5_reg = (eq5_reg & ~EQ_CUTOFF_MASK) | EQ_CUTOFF_VALUE(value);
|
|
wmcodec_write(EQ5, eq5_reg);
|
|
}
|
|
|
|
/* Nice shutdown of WM8758 codec */
|
|
void audiohw_close(void)
|
|
{
|
|
audiohw_mute(true);
|
|
|
|
/* Disable Thermal shutdown */
|
|
wmcodec_write(OUTCTRL, OUTCTRL_HP_COM | OUTCTRL_VROI);
|
|
/* Enable VMIDTOG */
|
|
wmcodec_write(OUT4TOADC, OUT4TOADC_VMIDTOG);
|
|
/* Disable VMIDSEL and BUFIOEN */
|
|
wmcodec_write(PWRMGMT1, PWRMGMT1_PLLEN | PWRMGMT1_BIASEN
|
|
| PWRMGMT1_VMIDSEL_OFF);
|
|
/* Wait for VMID to discharge */
|
|
sleep(3*HZ/10);
|
|
/* Power off registers */
|
|
wmcodec_write(PWRMGMT2, 0);
|
|
wmcodec_write(PWRMGMT3, 0);
|
|
wmcodec_write(PWRMGMT1, 0);
|
|
}
|
|
|
|
/* Note: Disable output before calling this function */
|
|
void audiohw_set_frequency(int fsel)
|
|
{
|
|
/* CLKCTRL_MCLKDIV_MASK and ADDCTRL_SR_MASK don't overlap,
|
|
so they can both fit in one byte. Bit 0 selects PLL
|
|
configuration via pll_setups.
|
|
*/
|
|
static const unsigned char freq_setups[HW_NUM_FREQ] =
|
|
{
|
|
[HW_FREQ_48] = CLKCTRL_MCLKDIV_2 | ADDCTRL_SR_48kHz | 1,
|
|
[HW_FREQ_44] = CLKCTRL_MCLKDIV_2 | ADDCTRL_SR_48kHz,
|
|
[HW_FREQ_32] = CLKCTRL_MCLKDIV_3 | ADDCTRL_SR_32kHz | 1,
|
|
[HW_FREQ_24] = CLKCTRL_MCLKDIV_4 | ADDCTRL_SR_24kHz | 1,
|
|
[HW_FREQ_22] = CLKCTRL_MCLKDIV_4 | ADDCTRL_SR_24kHz,
|
|
[HW_FREQ_16] = CLKCTRL_MCLKDIV_6 | ADDCTRL_SR_16kHz | 1,
|
|
[HW_FREQ_12] = CLKCTRL_MCLKDIV_8 | ADDCTRL_SR_12kHz | 1,
|
|
[HW_FREQ_11] = CLKCTRL_MCLKDIV_8 | ADDCTRL_SR_12kHz,
|
|
[HW_FREQ_8] = CLKCTRL_MCLKDIV_12 | ADDCTRL_SR_8kHz | 1
|
|
};
|
|
|
|
/* Each PLL configuration is an array consisting of
|
|
{ PLLN, PLLK1, PLLK2, PLLK3 }. The WM8983 datasheet requires
|
|
5 < PLLN < 13, and states optimum is PLLN = 8, f2 = 90 MHz
|
|
*/
|
|
static const unsigned short pll_setups[2][4] =
|
|
{
|
|
/* f1 = 12 MHz, R = 7.5264, f2 = 90.3168 MHz, fPLLOUT = 22.5792 MHz */
|
|
{ PLLN_PLLPRESCALE | 0x7, 0x21, 0x161, 0x26 },
|
|
/* f1 = 12 MHz, R = 8.192, f2 = 98.304 MHz, fPLLOUT = 24.576 MHz */
|
|
{ PLLN_PLLPRESCALE | 0x8, 0xC, 0x93, 0xE9 }
|
|
};
|
|
|
|
int i;
|
|
|
|
/* PLLN, PLLK1, PLLK2, PLLK3 are contiguous (at 0x24 to 0x27) */
|
|
for (i = 0; i < 4; i++)
|
|
wmcodec_write(PLLN + i, pll_setups[freq_setups[fsel] & 1][i]);
|
|
|
|
/* CLKCTRL_MCLKDIV divides fPLLOUT to get SYSCLK (256 * sample rate) */
|
|
wmcodec_write(CLKCTRL, CLKCTRL_CLKSEL
|
|
| (freq_setups[fsel] & CLKCTRL_MCLKDIV_MASK)
|
|
| CLKCTRL_BCLKDIV_2 | CLKCTRL_MS);
|
|
|
|
/* set ADC and DAC filter characteristics according to sample rate */
|
|
wmcodec_write(ADDCTRL, (freq_setups[fsel] & ADDCTRL_SR_MASK)
|
|
| ADDCTRL_SLOWCLKEN);
|
|
/* SLOWCLK enabled for zero cross timeout to work */
|
|
}
|
|
|
|
void audiohw_enable_recording(bool source_mic)
|
|
{
|
|
(void)source_mic; /* We only have a line-in (I think) */
|
|
|
|
wmcodec_write(PWRMGMT2, PWRMGMT2_ROUT1EN | PWRMGMT2_LOUT1EN
|
|
| PWRMGMT2_INPGAENR | PWRMGMT2_INPGAENL
|
|
| PWRMGMT2_ADCENR | PWRMGMT2_ADCENL);
|
|
|
|
wmcodec_write(INCTRL, INCTRL_R2_2INPGA | INCTRL_L2_2INPGA);
|
|
|
|
wmcodec_write(LADCBOOST, LADCBOOST_L2_2BOOST(5));
|
|
wmcodec_write(RADCBOOST, RADCBOOST_R2_2BOOST(5));
|
|
|
|
/* Enable monitoring */
|
|
wmcodec_write(LOUTMIX, LOUTMIX_BYP2LMIXVOL(5)
|
|
| LOUTMIX_BYPL2LMIX | LOUTMIX_DACL2LMIX);
|
|
wmcodec_write(ROUTMIX, ROUTMIX_BYP2RMIXVOL(5)
|
|
| ROUTMIX_BYPR2RMIX | ROUTMIX_DACR2RMIX);
|
|
}
|
|
|
|
void audiohw_disable_recording(void)
|
|
{
|
|
wmcodec_write(LOUTMIX, LOUTMIX_DACL2LMIX);
|
|
wmcodec_write(ROUTMIX, ROUTMIX_DACR2RMIX);
|
|
|
|
wmcodec_write(PWRMGMT2, PWRMGMT2_ROUT1EN | PWRMGMT2_LOUT1EN);
|
|
}
|
|
|
|
void audiohw_set_recvol(int left, int right, int type)
|
|
{
|
|
switch (type)
|
|
{
|
|
case AUDIO_GAIN_MIC:
|
|
right = left;
|
|
/* fall through */
|
|
case AUDIO_GAIN_LINEIN:
|
|
wmcodec_write(LINPGAVOL, LINPGAVOL_INPGAZCL
|
|
| (left & LINPGAVOL_INPGAVOL_MASK));
|
|
wmcodec_write(RINPGAVOL, RINPGAVOL_INPGAVU | RINPGAVOL_INPGAZCR
|
|
| (right & RINPGAVOL_INPGAVOL_MASK));
|
|
break;
|
|
default:
|
|
return;
|
|
}
|
|
}
|
|
|
|
void audiohw_set_monitor(bool enable)
|
|
{
|
|
(void)enable;
|
|
}
|