6c97145e7d
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@31396 a1c6a512-1295-4272-9138-f99709370657
356 lines
11 KiB
C
356 lines
11 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 "string.h"
|
|
#include "audio.h"
|
|
|
|
#include "wmcodec.h"
|
|
#include "audiohw.h"
|
|
#include "sound.h"
|
|
|
|
const struct sound_settings_info audiohw_settings[] = {
|
|
[SOUND_VOLUME] = {"dB", 0, 1, -90, 6, -25},
|
|
[SOUND_BASS] = {"dB", 0, 1, -12, 12, 0},
|
|
[SOUND_TREBLE] = {"dB", 0, 1, -12, 12, 0},
|
|
[SOUND_BALANCE] = {"%", 0, 1,-100, 100, 0},
|
|
[SOUND_CHANNELS] = {"", 0, 1, 0, 5, 0},
|
|
[SOUND_STEREO_WIDTH] = {"%", 0, 5, 0, 250, 100},
|
|
#ifdef HAVE_RECORDING
|
|
[SOUND_LEFT_GAIN] = {"dB", 1, 1, 0, 63, 16},
|
|
[SOUND_RIGHT_GAIN] = {"dB", 1, 1, 0, 63, 16},
|
|
[SOUND_MIC_GAIN] = {"dB", 1, 1, 0, 63, 16},
|
|
#endif
|
|
[SOUND_BASS_CUTOFF] = {"", 0, 1, 1, 4, 1},
|
|
[SOUND_TREBLE_CUTOFF] = {"", 0, 1, 1, 4, 1},
|
|
};
|
|
|
|
/* 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 */
|
|
int tenthdb2master(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 < VOLUME_MIN) {
|
|
return 0;
|
|
} else {
|
|
return (db-VOLUME_MIN)/10 + 1;
|
|
}
|
|
}
|
|
|
|
/* 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;
|
|
}
|
|
}
|
|
|
|
int sound_val2phys(int setting, int value)
|
|
{
|
|
int result;
|
|
|
|
switch(setting)
|
|
{
|
|
#ifdef HAVE_RECORDING
|
|
case SOUND_LEFT_GAIN:
|
|
case SOUND_RIGHT_GAIN:
|
|
case SOUND_MIC_GAIN:
|
|
result = ((value - 16) * 15) / 2;
|
|
break;
|
|
#endif
|
|
default:
|
|
result = value;
|
|
break;
|
|
}
|
|
|
|
return result;
|
|
}
|
|
|
|
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_master_vol(int vol_l, int vol_r)
|
|
{
|
|
int dac_l, amp_l, dac_r, amp_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_vol(int vol_l, int vol_r)
|
|
{
|
|
int dac_l, amp_l, dac_r, amp_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;
|
|
}
|