1542 lines
43 KiB
C
1542 lines
43 KiB
C
|
/*
|
||
|
* wm8900.c -- WM8900 ALSA Soc Audio driver
|
||
|
*
|
||
|
* Copyright 2007, 2008 Wolfson Microelectronics PLC.
|
||
|
*
|
||
|
* Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
|
||
|
*
|
||
|
* 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.
|
||
|
*
|
||
|
* TODO:
|
||
|
* - Tristating.
|
||
|
* - TDM.
|
||
|
* - Jack detect.
|
||
|
* - FLL source configuration, currently only MCLK is supported.
|
||
|
*/
|
||
|
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/moduleparam.h>
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/init.h>
|
||
|
#include <linux/delay.h>
|
||
|
#include <linux/pm.h>
|
||
|
#include <linux/i2c.h>
|
||
|
#include <linux/platform_device.h>
|
||
|
#include <sound/core.h>
|
||
|
#include <sound/pcm.h>
|
||
|
#include <sound/pcm_params.h>
|
||
|
#include <sound/soc.h>
|
||
|
#include <sound/soc-dapm.h>
|
||
|
#include <sound/initval.h>
|
||
|
#include <sound/tlv.h>
|
||
|
|
||
|
#include "wm8900.h"
|
||
|
|
||
|
/* WM8900 register space */
|
||
|
#define WM8900_REG_RESET 0x0
|
||
|
#define WM8900_REG_ID 0x0
|
||
|
#define WM8900_REG_POWER1 0x1
|
||
|
#define WM8900_REG_POWER2 0x2
|
||
|
#define WM8900_REG_POWER3 0x3
|
||
|
#define WM8900_REG_AUDIO1 0x4
|
||
|
#define WM8900_REG_AUDIO2 0x5
|
||
|
#define WM8900_REG_CLOCKING1 0x6
|
||
|
#define WM8900_REG_CLOCKING2 0x7
|
||
|
#define WM8900_REG_AUDIO3 0x8
|
||
|
#define WM8900_REG_AUDIO4 0x9
|
||
|
#define WM8900_REG_DACCTRL 0xa
|
||
|
#define WM8900_REG_LDAC_DV 0xb
|
||
|
#define WM8900_REG_RDAC_DV 0xc
|
||
|
#define WM8900_REG_SIDETONE 0xd
|
||
|
#define WM8900_REG_ADCCTRL 0xe
|
||
|
#define WM8900_REG_LADC_DV 0xf
|
||
|
#define WM8900_REG_RADC_DV 0x10
|
||
|
#define WM8900_REG_GPIO 0x12
|
||
|
#define WM8900_REG_INCTL 0x15
|
||
|
#define WM8900_REG_LINVOL 0x16
|
||
|
#define WM8900_REG_RINVOL 0x17
|
||
|
#define WM8900_REG_INBOOSTMIX1 0x18
|
||
|
#define WM8900_REG_INBOOSTMIX2 0x19
|
||
|
#define WM8900_REG_ADCPATH 0x1a
|
||
|
#define WM8900_REG_AUXBOOST 0x1b
|
||
|
#define WM8900_REG_ADDCTL 0x1e
|
||
|
#define WM8900_REG_FLLCTL1 0x24
|
||
|
#define WM8900_REG_FLLCTL2 0x25
|
||
|
#define WM8900_REG_FLLCTL3 0x26
|
||
|
#define WM8900_REG_FLLCTL4 0x27
|
||
|
#define WM8900_REG_FLLCTL5 0x28
|
||
|
#define WM8900_REG_FLLCTL6 0x29
|
||
|
#define WM8900_REG_LOUTMIXCTL1 0x2c
|
||
|
#define WM8900_REG_ROUTMIXCTL1 0x2d
|
||
|
#define WM8900_REG_BYPASS1 0x2e
|
||
|
#define WM8900_REG_BYPASS2 0x2f
|
||
|
#define WM8900_REG_AUXOUT_CTL 0x30
|
||
|
#define WM8900_REG_LOUT1CTL 0x33
|
||
|
#define WM8900_REG_ROUT1CTL 0x34
|
||
|
#define WM8900_REG_LOUT2CTL 0x35
|
||
|
#define WM8900_REG_ROUT2CTL 0x36
|
||
|
#define WM8900_REG_HPCTL1 0x3a
|
||
|
#define WM8900_REG_OUTBIASCTL 0x73
|
||
|
|
||
|
#define WM8900_MAXREG 0x80
|
||
|
|
||
|
#define WM8900_REG_ADDCTL_OUT1_DIS 0x80
|
||
|
#define WM8900_REG_ADDCTL_OUT2_DIS 0x40
|
||
|
#define WM8900_REG_ADDCTL_VMID_DIS 0x20
|
||
|
#define WM8900_REG_ADDCTL_BIAS_SRC 0x10
|
||
|
#define WM8900_REG_ADDCTL_VMID_SOFTST 0x04
|
||
|
#define WM8900_REG_ADDCTL_TEMP_SD 0x02
|
||
|
|
||
|
#define WM8900_REG_GPIO_TEMP_ENA 0x2
|
||
|
|
||
|
#define WM8900_REG_POWER1_STARTUP_BIAS_ENA 0x0100
|
||
|
#define WM8900_REG_POWER1_BIAS_ENA 0x0008
|
||
|
#define WM8900_REG_POWER1_VMID_BUF_ENA 0x0004
|
||
|
#define WM8900_REG_POWER1_FLL_ENA 0x0040
|
||
|
|
||
|
#define WM8900_REG_POWER2_SYSCLK_ENA 0x8000
|
||
|
#define WM8900_REG_POWER2_ADCL_ENA 0x0002
|
||
|
#define WM8900_REG_POWER2_ADCR_ENA 0x0001
|
||
|
|
||
|
#define WM8900_REG_POWER3_DACL_ENA 0x0002
|
||
|
#define WM8900_REG_POWER3_DACR_ENA 0x0001
|
||
|
|
||
|
#define WM8900_REG_AUDIO1_AIF_FMT_MASK 0x0018
|
||
|
#define WM8900_REG_AUDIO1_LRCLK_INV 0x0080
|
||
|
#define WM8900_REG_AUDIO1_BCLK_INV 0x0100
|
||
|
|
||
|
#define WM8900_REG_CLOCKING1_BCLK_DIR 0x1
|
||
|
#define WM8900_REG_CLOCKING1_MCLK_SRC 0x100
|
||
|
#define WM8900_REG_CLOCKING1_BCLK_MASK (~0x01e)
|
||
|
#define WM8900_REG_CLOCKING1_OPCLK_MASK (~0x7000)
|
||
|
|
||
|
#define WM8900_REG_CLOCKING2_ADC_CLKDIV 0xe0
|
||
|
#define WM8900_REG_CLOCKING2_DAC_CLKDIV 0x1c
|
||
|
|
||
|
#define WM8900_REG_DACCTRL_MUTE 0x004
|
||
|
#define WM8900_REG_DACCTRL_AIF_LRCLKRATE 0x400
|
||
|
|
||
|
#define WM8900_REG_AUDIO3_ADCLRC_DIR 0x0800
|
||
|
|
||
|
#define WM8900_REG_AUDIO4_DACLRC_DIR 0x0800
|
||
|
|
||
|
#define WM8900_REG_FLLCTL1_OSC_ENA 0x100
|
||
|
|
||
|
#define WM8900_REG_FLLCTL6_FLL_SLOW_LOCK_REF 0x100
|
||
|
|
||
|
#define WM8900_REG_HPCTL1_HP_IPSTAGE_ENA 0x80
|
||
|
#define WM8900_REG_HPCTL1_HP_OPSTAGE_ENA 0x40
|
||
|
#define WM8900_REG_HPCTL1_HP_CLAMP_IP 0x20
|
||
|
#define WM8900_REG_HPCTL1_HP_CLAMP_OP 0x10
|
||
|
#define WM8900_REG_HPCTL1_HP_SHORT 0x08
|
||
|
#define WM8900_REG_HPCTL1_HP_SHORT2 0x04
|
||
|
|
||
|
#define WM8900_LRC_MASK 0xfc00
|
||
|
|
||
|
struct snd_soc_codec_device soc_codec_dev_wm8900;
|
||
|
|
||
|
struct wm8900_priv {
|
||
|
u32 fll_in; /* FLL input frequency */
|
||
|
u32 fll_out; /* FLL output frequency */
|
||
|
};
|
||
|
|
||
|
/*
|
||
|
* wm8900 register cache. We can't read the entire register space and we
|
||
|
* have slow control buses so we cache the registers.
|
||
|
*/
|
||
|
static const u16 wm8900_reg_defaults[WM8900_MAXREG] = {
|
||
|
0x8900, 0x0000,
|
||
|
0xc000, 0x0000,
|
||
|
0x4050, 0x4000,
|
||
|
0x0008, 0x0000,
|
||
|
0x0040, 0x0040,
|
||
|
0x1004, 0x00c0,
|
||
|
0x00c0, 0x0000,
|
||
|
0x0100, 0x00c0,
|
||
|
0x00c0, 0x0000,
|
||
|
0xb001, 0x0000,
|
||
|
0x0000, 0x0044,
|
||
|
0x004c, 0x004c,
|
||
|
0x0044, 0x0044,
|
||
|
0x0000, 0x0044,
|
||
|
0x0000, 0x0000,
|
||
|
0x0002, 0x0000,
|
||
|
0x0000, 0x0000,
|
||
|
0x0000, 0x0000,
|
||
|
0x0008, 0x0000,
|
||
|
0x0000, 0x0008,
|
||
|
0x0097, 0x0100,
|
||
|
0x0000, 0x0000,
|
||
|
0x0050, 0x0050,
|
||
|
0x0055, 0x0055,
|
||
|
0x0055, 0x0000,
|
||
|
0x0000, 0x0079,
|
||
|
0x0079, 0x0079,
|
||
|
0x0079, 0x0000,
|
||
|
/* Remaining registers all zero */
|
||
|
};
|
||
|
|
||
|
/*
|
||
|
* read wm8900 register cache
|
||
|
*/
|
||
|
static inline unsigned int wm8900_read_reg_cache(struct snd_soc_codec *codec,
|
||
|
unsigned int reg)
|
||
|
{
|
||
|
u16 *cache = codec->reg_cache;
|
||
|
|
||
|
BUG_ON(reg >= WM8900_MAXREG);
|
||
|
|
||
|
if (reg == WM8900_REG_ID)
|
||
|
return 0;
|
||
|
|
||
|
return cache[reg];
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* write wm8900 register cache
|
||
|
*/
|
||
|
static inline void wm8900_write_reg_cache(struct snd_soc_codec *codec,
|
||
|
u16 reg, unsigned int value)
|
||
|
{
|
||
|
u16 *cache = codec->reg_cache;
|
||
|
|
||
|
BUG_ON(reg >= WM8900_MAXREG);
|
||
|
|
||
|
cache[reg] = value;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* write to the WM8900 register space
|
||
|
*/
|
||
|
static int wm8900_write(struct snd_soc_codec *codec, unsigned int reg,
|
||
|
unsigned int value)
|
||
|
{
|
||
|
u8 data[3];
|
||
|
|
||
|
if (value == wm8900_read_reg_cache(codec, reg))
|
||
|
return 0;
|
||
|
|
||
|
/* data is
|
||
|
* D15..D9 WM8900 register offset
|
||
|
* D8...D0 register data
|
||
|
*/
|
||
|
data[0] = reg;
|
||
|
data[1] = value >> 8;
|
||
|
data[2] = value & 0x00ff;
|
||
|
|
||
|
wm8900_write_reg_cache(codec, reg, value);
|
||
|
if (codec->hw_write(codec->control_data, data, 3) == 3)
|
||
|
return 0;
|
||
|
else
|
||
|
return -EIO;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Read from the wm8900.
|
||
|
*/
|
||
|
static unsigned int wm8900_chip_read(struct snd_soc_codec *codec, u8 reg)
|
||
|
{
|
||
|
struct i2c_msg xfer[2];
|
||
|
u16 data;
|
||
|
int ret;
|
||
|
struct i2c_client *client = codec->control_data;
|
||
|
|
||
|
BUG_ON(reg != WM8900_REG_ID && reg != WM8900_REG_POWER1);
|
||
|
|
||
|
/* Write register */
|
||
|
xfer[0].addr = client->addr;
|
||
|
xfer[0].flags = 0;
|
||
|
xfer[0].len = 1;
|
||
|
xfer[0].buf = ®
|
||
|
|
||
|
/* Read data */
|
||
|
xfer[1].addr = client->addr;
|
||
|
xfer[1].flags = I2C_M_RD;
|
||
|
xfer[1].len = 2;
|
||
|
xfer[1].buf = (u8 *)&data;
|
||
|
|
||
|
ret = i2c_transfer(client->adapter, xfer, 2);
|
||
|
if (ret != 2) {
|
||
|
printk(KERN_CRIT "i2c_transfer returned %d\n", ret);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
return (data >> 8) | ((data & 0xff) << 8);
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Read from the WM8900 register space. Most registers can't be read
|
||
|
* and are therefore supplied from cache.
|
||
|
*/
|
||
|
static unsigned int wm8900_read(struct snd_soc_codec *codec, unsigned int reg)
|
||
|
{
|
||
|
switch (reg) {
|
||
|
case WM8900_REG_ID:
|
||
|
return wm8900_chip_read(codec, reg);
|
||
|
default:
|
||
|
return wm8900_read_reg_cache(codec, reg);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static void wm8900_reset(struct snd_soc_codec *codec)
|
||
|
{
|
||
|
wm8900_write(codec, WM8900_REG_RESET, 0);
|
||
|
|
||
|
memcpy(codec->reg_cache, wm8900_reg_defaults,
|
||
|
sizeof(codec->reg_cache));
|
||
|
}
|
||
|
|
||
|
static int wm8900_hp_event(struct snd_soc_dapm_widget *w,
|
||
|
struct snd_kcontrol *kcontrol, int event)
|
||
|
{
|
||
|
struct snd_soc_codec *codec = w->codec;
|
||
|
u16 hpctl1 = wm8900_read(codec, WM8900_REG_HPCTL1);
|
||
|
|
||
|
switch (event) {
|
||
|
case SND_SOC_DAPM_PRE_PMU:
|
||
|
/* Clamp headphone outputs */
|
||
|
hpctl1 = WM8900_REG_HPCTL1_HP_CLAMP_IP |
|
||
|
WM8900_REG_HPCTL1_HP_CLAMP_OP;
|
||
|
wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
|
||
|
break;
|
||
|
|
||
|
case SND_SOC_DAPM_POST_PMU:
|
||
|
/* Enable the input stage */
|
||
|
hpctl1 &= ~WM8900_REG_HPCTL1_HP_CLAMP_IP;
|
||
|
hpctl1 |= WM8900_REG_HPCTL1_HP_SHORT |
|
||
|
WM8900_REG_HPCTL1_HP_SHORT2 |
|
||
|
WM8900_REG_HPCTL1_HP_IPSTAGE_ENA;
|
||
|
wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
|
||
|
|
||
|
msleep(400);
|
||
|
|
||
|
/* Enable the output stage */
|
||
|
hpctl1 &= ~WM8900_REG_HPCTL1_HP_CLAMP_OP;
|
||
|
hpctl1 |= WM8900_REG_HPCTL1_HP_OPSTAGE_ENA;
|
||
|
wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
|
||
|
|
||
|
/* Remove the shorts */
|
||
|
hpctl1 &= ~WM8900_REG_HPCTL1_HP_SHORT2;
|
||
|
wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
|
||
|
hpctl1 &= ~WM8900_REG_HPCTL1_HP_SHORT;
|
||
|
wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
|
||
|
break;
|
||
|
|
||
|
case SND_SOC_DAPM_PRE_PMD:
|
||
|
/* Short the output */
|
||
|
hpctl1 |= WM8900_REG_HPCTL1_HP_SHORT;
|
||
|
wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
|
||
|
|
||
|
/* Disable the output stage */
|
||
|
hpctl1 &= ~WM8900_REG_HPCTL1_HP_OPSTAGE_ENA;
|
||
|
wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
|
||
|
|
||
|
/* Clamp the outputs and power down input */
|
||
|
hpctl1 |= WM8900_REG_HPCTL1_HP_CLAMP_IP |
|
||
|
WM8900_REG_HPCTL1_HP_CLAMP_OP;
|
||
|
hpctl1 &= ~WM8900_REG_HPCTL1_HP_IPSTAGE_ENA;
|
||
|
wm8900_write(codec, WM8900_REG_HPCTL1, hpctl1);
|
||
|
break;
|
||
|
|
||
|
case SND_SOC_DAPM_POST_PMD:
|
||
|
/* Disable everything */
|
||
|
wm8900_write(codec, WM8900_REG_HPCTL1, 0);
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
BUG();
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static const DECLARE_TLV_DB_SCALE(out_pga_tlv, -5700, 100, 0);
|
||
|
|
||
|
static const DECLARE_TLV_DB_SCALE(out_mix_tlv, -1500, 300, 0);
|
||
|
|
||
|
static const DECLARE_TLV_DB_SCALE(in_boost_tlv, -1200, 600, 0);
|
||
|
|
||
|
static const DECLARE_TLV_DB_SCALE(in_pga_tlv, -1200, 100, 0);
|
||
|
|
||
|
static const DECLARE_TLV_DB_SCALE(dac_boost_tlv, 0, 600, 0);
|
||
|
|
||
|
static const DECLARE_TLV_DB_SCALE(dac_tlv, -7200, 75, 1);
|
||
|
|
||
|
static const DECLARE_TLV_DB_SCALE(adc_svol_tlv, -3600, 300, 0);
|
||
|
|
||
|
static const DECLARE_TLV_DB_SCALE(adc_tlv, -7200, 75, 1);
|
||
|
|
||
|
static const char *mic_bias_level_txt[] = { "0.9*AVDD", "0.65*AVDD" };
|
||
|
|
||
|
static const struct soc_enum mic_bias_level =
|
||
|
SOC_ENUM_SINGLE(WM8900_REG_INCTL, 8, 2, mic_bias_level_txt);
|
||
|
|
||
|
static const char *dac_mute_rate_txt[] = { "Fast", "Slow" };
|
||
|
|
||
|
static const struct soc_enum dac_mute_rate =
|
||
|
SOC_ENUM_SINGLE(WM8900_REG_DACCTRL, 7, 2, dac_mute_rate_txt);
|
||
|
|
||
|
static const char *dac_deemphasis_txt[] = {
|
||
|
"Disabled", "32kHz", "44.1kHz", "48kHz"
|
||
|
};
|
||
|
|
||
|
static const struct soc_enum dac_deemphasis =
|
||
|
SOC_ENUM_SINGLE(WM8900_REG_DACCTRL, 4, 4, dac_deemphasis_txt);
|
||
|
|
||
|
static const char *adc_hpf_cut_txt[] = {
|
||
|
"Hi-fi mode", "Voice mode 1", "Voice mode 2", "Voice mode 3"
|
||
|
};
|
||
|
|
||
|
static const struct soc_enum adc_hpf_cut =
|
||
|
SOC_ENUM_SINGLE(WM8900_REG_ADCCTRL, 5, 4, adc_hpf_cut_txt);
|
||
|
|
||
|
static const char *lr_txt[] = {
|
||
|
"Left", "Right"
|
||
|
};
|
||
|
|
||
|
static const struct soc_enum aifl_src =
|
||
|
SOC_ENUM_SINGLE(WM8900_REG_AUDIO1, 15, 2, lr_txt);
|
||
|
|
||
|
static const struct soc_enum aifr_src =
|
||
|
SOC_ENUM_SINGLE(WM8900_REG_AUDIO1, 14, 2, lr_txt);
|
||
|
|
||
|
static const struct soc_enum dacl_src =
|
||
|
SOC_ENUM_SINGLE(WM8900_REG_AUDIO2, 15, 2, lr_txt);
|
||
|
|
||
|
static const struct soc_enum dacr_src =
|
||
|
SOC_ENUM_SINGLE(WM8900_REG_AUDIO2, 14, 2, lr_txt);
|
||
|
|
||
|
static const char *sidetone_txt[] = {
|
||
|
"Disabled", "Left ADC", "Right ADC"
|
||
|
};
|
||
|
|
||
|
static const struct soc_enum dacl_sidetone =
|
||
|
SOC_ENUM_SINGLE(WM8900_REG_SIDETONE, 2, 3, sidetone_txt);
|
||
|
|
||
|
static const struct soc_enum dacr_sidetone =
|
||
|
SOC_ENUM_SINGLE(WM8900_REG_SIDETONE, 0, 3, sidetone_txt);
|
||
|
|
||
|
static const struct snd_kcontrol_new wm8900_snd_controls[] = {
|
||
|
SOC_ENUM("Mic Bias Level", mic_bias_level),
|
||
|
|
||
|
SOC_SINGLE_TLV("Left Input PGA Volume", WM8900_REG_LINVOL, 0, 31, 0,
|
||
|
in_pga_tlv),
|
||
|
SOC_SINGLE("Left Input PGA Switch", WM8900_REG_LINVOL, 6, 1, 1),
|
||
|
SOC_SINGLE("Left Input PGA ZC Switch", WM8900_REG_LINVOL, 7, 1, 0),
|
||
|
|
||
|
SOC_SINGLE_TLV("Right Input PGA Volume", WM8900_REG_RINVOL, 0, 31, 0,
|
||
|
in_pga_tlv),
|
||
|
SOC_SINGLE("Right Input PGA Switch", WM8900_REG_RINVOL, 6, 1, 1),
|
||
|
SOC_SINGLE("Right Input PGA ZC Switch", WM8900_REG_RINVOL, 7, 1, 0),
|
||
|
|
||
|
SOC_SINGLE("DAC Soft Mute Switch", WM8900_REG_DACCTRL, 6, 1, 1),
|
||
|
SOC_ENUM("DAC Mute Rate", dac_mute_rate),
|
||
|
SOC_SINGLE("DAC Mono Switch", WM8900_REG_DACCTRL, 9, 1, 0),
|
||
|
SOC_ENUM("DAC Deemphasis", dac_deemphasis),
|
||
|
SOC_SINGLE("DAC Sloping Stopband Filter Switch", WM8900_REG_DACCTRL, 8, 1, 0),
|
||
|
SOC_SINGLE("DAC Sigma-Delta Modulator Clock Switch", WM8900_REG_DACCTRL,
|
||
|
12, 1, 0),
|
||
|
|
||
|
SOC_SINGLE("ADC HPF Switch", WM8900_REG_ADCCTRL, 8, 1, 0),
|
||
|
SOC_ENUM("ADC HPF Cut-Off", adc_hpf_cut),
|
||
|
SOC_DOUBLE("ADC Invert Switch", WM8900_REG_ADCCTRL, 1, 0, 1, 0),
|
||
|
SOC_SINGLE_TLV("Left ADC Sidetone Volume", WM8900_REG_SIDETONE, 9, 12, 0,
|
||
|
adc_svol_tlv),
|
||
|
SOC_SINGLE_TLV("Right ADC Sidetone Volume", WM8900_REG_SIDETONE, 5, 12, 0,
|
||
|
adc_svol_tlv),
|
||
|
SOC_ENUM("Left Digital Audio Source", aifl_src),
|
||
|
SOC_ENUM("Right Digital Audio Source", aifr_src),
|
||
|
|
||
|
SOC_SINGLE_TLV("DAC Input Boost Volume", WM8900_REG_AUDIO2, 10, 4, 0,
|
||
|
dac_boost_tlv),
|
||
|
SOC_ENUM("Left DAC Source", dacl_src),
|
||
|
SOC_ENUM("Right DAC Source", dacr_src),
|
||
|
SOC_ENUM("Left DAC Sidetone", dacl_sidetone),
|
||
|
SOC_ENUM("Right DAC Sidetone", dacr_sidetone),
|
||
|
SOC_DOUBLE("DAC Invert Switch", WM8900_REG_DACCTRL, 1, 0, 1, 0),
|
||
|
|
||
|
SOC_DOUBLE_R_TLV("Digital Playback Volume",
|
||
|
WM8900_REG_LDAC_DV, WM8900_REG_RDAC_DV,
|
||
|
1, 96, 0, dac_tlv),
|
||
|
SOC_DOUBLE_R_TLV("Digital Capture Volume",
|
||
|
WM8900_REG_LADC_DV, WM8900_REG_RADC_DV, 1, 119, 0, adc_tlv),
|
||
|
|
||
|
SOC_SINGLE_TLV("LINPUT3 Bypass Volume", WM8900_REG_LOUTMIXCTL1, 4, 7, 0,
|
||
|
out_mix_tlv),
|
||
|
SOC_SINGLE_TLV("RINPUT3 Bypass Volume", WM8900_REG_ROUTMIXCTL1, 4, 7, 0,
|
||
|
out_mix_tlv),
|
||
|
SOC_SINGLE_TLV("Left AUX Bypass Volume", WM8900_REG_AUXOUT_CTL, 4, 7, 0,
|
||
|
out_mix_tlv),
|
||
|
SOC_SINGLE_TLV("Right AUX Bypass Volume", WM8900_REG_AUXOUT_CTL, 0, 7, 0,
|
||
|
out_mix_tlv),
|
||
|
|
||
|
SOC_SINGLE_TLV("LeftIn to RightOut Mixer Volume", WM8900_REG_BYPASS1, 0, 7, 0,
|
||
|
out_mix_tlv),
|
||
|
SOC_SINGLE_TLV("LeftIn to LeftOut Mixer Volume", WM8900_REG_BYPASS1, 4, 7, 0,
|
||
|
out_mix_tlv),
|
||
|
SOC_SINGLE_TLV("RightIn to LeftOut Mixer Volume", WM8900_REG_BYPASS2, 0, 7, 0,
|
||
|
out_mix_tlv),
|
||
|
SOC_SINGLE_TLV("RightIn to RightOut Mixer Volume", WM8900_REG_BYPASS2, 4, 7, 0,
|
||
|
out_mix_tlv),
|
||
|
|
||
|
SOC_SINGLE_TLV("IN2L Boost Volume", WM8900_REG_INBOOSTMIX1, 0, 3, 0,
|
||
|
in_boost_tlv),
|
||
|
SOC_SINGLE_TLV("IN3L Boost Volume", WM8900_REG_INBOOSTMIX1, 4, 3, 0,
|
||
|
in_boost_tlv),
|
||
|
SOC_SINGLE_TLV("IN2R Boost Volume", WM8900_REG_INBOOSTMIX2, 0, 3, 0,
|
||
|
in_boost_tlv),
|
||
|
SOC_SINGLE_TLV("IN3R Boost Volume", WM8900_REG_INBOOSTMIX2, 4, 3, 0,
|
||
|
in_boost_tlv),
|
||
|
SOC_SINGLE_TLV("Left AUX Boost Volume", WM8900_REG_AUXBOOST, 4, 3, 0,
|
||
|
in_boost_tlv),
|
||
|
SOC_SINGLE_TLV("Right AUX Boost Volume", WM8900_REG_AUXBOOST, 0, 3, 0,
|
||
|
in_boost_tlv),
|
||
|
|
||
|
SOC_DOUBLE_R_TLV("LINEOUT1 Volume", WM8900_REG_LOUT1CTL, WM8900_REG_ROUT1CTL,
|
||
|
0, 63, 0, out_pga_tlv),
|
||
|
SOC_DOUBLE_R("LINEOUT1 Switch", WM8900_REG_LOUT1CTL, WM8900_REG_ROUT1CTL,
|
||
|
6, 1, 1),
|
||
|
SOC_DOUBLE_R("LINEOUT1 ZC Switch", WM8900_REG_LOUT1CTL, WM8900_REG_ROUT1CTL,
|
||
|
7, 1, 0),
|
||
|
|
||
|
SOC_DOUBLE_R_TLV("LINEOUT2 Volume",
|
||
|
WM8900_REG_LOUT2CTL, WM8900_REG_ROUT2CTL,
|
||
|
0, 63, 0, out_pga_tlv),
|
||
|
SOC_DOUBLE_R("LINEOUT2 Switch",
|
||
|
WM8900_REG_LOUT2CTL, WM8900_REG_ROUT2CTL, 6, 1, 1),
|
||
|
SOC_DOUBLE_R("LINEOUT2 ZC Switch",
|
||
|
WM8900_REG_LOUT2CTL, WM8900_REG_ROUT2CTL, 7, 1, 0),
|
||
|
SOC_SINGLE("LINEOUT2 LP -12dB", WM8900_REG_LOUTMIXCTL1,
|
||
|
0, 1, 1),
|
||
|
|
||
|
};
|
||
|
|
||
|
/* add non dapm controls */
|
||
|
static int wm8900_add_controls(struct snd_soc_codec *codec)
|
||
|
{
|
||
|
int err, i;
|
||
|
|
||
|
for (i = 0; i < ARRAY_SIZE(wm8900_snd_controls); i++) {
|
||
|
err = snd_ctl_add(codec->card,
|
||
|
snd_soc_cnew(&wm8900_snd_controls[i],
|
||
|
codec, NULL));
|
||
|
if (err < 0)
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static const struct snd_kcontrol_new wm8900_dapm_loutput2_control =
|
||
|
SOC_DAPM_SINGLE("LINEOUT2L Switch", WM8900_REG_POWER3, 6, 1, 0);
|
||
|
|
||
|
static const struct snd_kcontrol_new wm8900_dapm_routput2_control =
|
||
|
SOC_DAPM_SINGLE("LINEOUT2R Switch", WM8900_REG_POWER3, 5, 1, 0);
|
||
|
|
||
|
static const struct snd_kcontrol_new wm8900_loutmix_controls[] = {
|
||
|
SOC_DAPM_SINGLE("LINPUT3 Bypass Switch", WM8900_REG_LOUTMIXCTL1, 7, 1, 0),
|
||
|
SOC_DAPM_SINGLE("AUX Bypass Switch", WM8900_REG_AUXOUT_CTL, 7, 1, 0),
|
||
|
SOC_DAPM_SINGLE("Left Input Mixer Switch", WM8900_REG_BYPASS1, 7, 1, 0),
|
||
|
SOC_DAPM_SINGLE("Right Input Mixer Switch", WM8900_REG_BYPASS2, 3, 1, 0),
|
||
|
SOC_DAPM_SINGLE("DACL Switch", WM8900_REG_LOUTMIXCTL1, 8, 1, 0),
|
||
|
};
|
||
|
|
||
|
static const struct snd_kcontrol_new wm8900_routmix_controls[] = {
|
||
|
SOC_DAPM_SINGLE("RINPUT3 Bypass Switch", WM8900_REG_ROUTMIXCTL1, 7, 1, 0),
|
||
|
SOC_DAPM_SINGLE("AUX Bypass Switch", WM8900_REG_AUXOUT_CTL, 3, 1, 0),
|
||
|
SOC_DAPM_SINGLE("Left Input Mixer Switch", WM8900_REG_BYPASS1, 3, 1, 0),
|
||
|
SOC_DAPM_SINGLE("Right Input Mixer Switch", WM8900_REG_BYPASS2, 7, 1, 0),
|
||
|
SOC_DAPM_SINGLE("DACR Switch", WM8900_REG_ROUTMIXCTL1, 8, 1, 0),
|
||
|
};
|
||
|
|
||
|
static const struct snd_kcontrol_new wm8900_linmix_controls[] = {
|
||
|
SOC_DAPM_SINGLE("LINPUT2 Switch", WM8900_REG_INBOOSTMIX1, 2, 1, 1),
|
||
|
SOC_DAPM_SINGLE("LINPUT3 Switch", WM8900_REG_INBOOSTMIX1, 6, 1, 1),
|
||
|
SOC_DAPM_SINGLE("AUX Switch", WM8900_REG_AUXBOOST, 6, 1, 1),
|
||
|
SOC_DAPM_SINGLE("Input PGA Switch", WM8900_REG_ADCPATH, 6, 1, 0),
|
||
|
};
|
||
|
|
||
|
static const struct snd_kcontrol_new wm8900_rinmix_controls[] = {
|
||
|
SOC_DAPM_SINGLE("RINPUT2 Switch", WM8900_REG_INBOOSTMIX2, 2, 1, 1),
|
||
|
SOC_DAPM_SINGLE("RINPUT3 Switch", WM8900_REG_INBOOSTMIX2, 6, 1, 1),
|
||
|
SOC_DAPM_SINGLE("AUX Switch", WM8900_REG_AUXBOOST, 2, 1, 1),
|
||
|
SOC_DAPM_SINGLE("Input PGA Switch", WM8900_REG_ADCPATH, 2, 1, 0),
|
||
|
};
|
||
|
|
||
|
static const struct snd_kcontrol_new wm8900_linpga_controls[] = {
|
||
|
SOC_DAPM_SINGLE("LINPUT1 Switch", WM8900_REG_INCTL, 6, 1, 0),
|
||
|
SOC_DAPM_SINGLE("LINPUT2 Switch", WM8900_REG_INCTL, 5, 1, 0),
|
||
|
SOC_DAPM_SINGLE("LINPUT3 Switch", WM8900_REG_INCTL, 4, 1, 0),
|
||
|
};
|
||
|
|
||
|
static const struct snd_kcontrol_new wm8900_rinpga_controls[] = {
|
||
|
SOC_DAPM_SINGLE("RINPUT1 Switch", WM8900_REG_INCTL, 2, 1, 0),
|
||
|
SOC_DAPM_SINGLE("RINPUT2 Switch", WM8900_REG_INCTL, 1, 1, 0),
|
||
|
SOC_DAPM_SINGLE("RINPUT3 Switch", WM8900_REG_INCTL, 0, 1, 0),
|
||
|
};
|
||
|
|
||
|
static const char *wm9700_lp_mux[] = { "Disabled", "Enabled" };
|
||
|
|
||
|
static const struct soc_enum wm8900_lineout2_lp_mux =
|
||
|
SOC_ENUM_SINGLE(WM8900_REG_LOUTMIXCTL1, 1, 2, wm9700_lp_mux);
|
||
|
|
||
|
static const struct snd_kcontrol_new wm8900_lineout2_lp =
|
||
|
SOC_DAPM_ENUM("Route", wm8900_lineout2_lp_mux);
|
||
|
|
||
|
static const struct snd_soc_dapm_widget wm8900_dapm_widgets[] = {
|
||
|
|
||
|
/* Externally visible pins */
|
||
|
SND_SOC_DAPM_OUTPUT("LINEOUT1L"),
|
||
|
SND_SOC_DAPM_OUTPUT("LINEOUT1R"),
|
||
|
SND_SOC_DAPM_OUTPUT("LINEOUT2L"),
|
||
|
SND_SOC_DAPM_OUTPUT("LINEOUT2R"),
|
||
|
SND_SOC_DAPM_OUTPUT("HP_L"),
|
||
|
SND_SOC_DAPM_OUTPUT("HP_R"),
|
||
|
|
||
|
SND_SOC_DAPM_INPUT("RINPUT1"),
|
||
|
SND_SOC_DAPM_INPUT("LINPUT1"),
|
||
|
SND_SOC_DAPM_INPUT("RINPUT2"),
|
||
|
SND_SOC_DAPM_INPUT("LINPUT2"),
|
||
|
SND_SOC_DAPM_INPUT("RINPUT3"),
|
||
|
SND_SOC_DAPM_INPUT("LINPUT3"),
|
||
|
SND_SOC_DAPM_INPUT("AUX"),
|
||
|
|
||
|
SND_SOC_DAPM_VMID("VMID"),
|
||
|
|
||
|
/* Input */
|
||
|
SND_SOC_DAPM_MIXER("Left Input PGA", WM8900_REG_POWER2, 3, 0,
|
||
|
wm8900_linpga_controls,
|
||
|
ARRAY_SIZE(wm8900_linpga_controls)),
|
||
|
SND_SOC_DAPM_MIXER("Right Input PGA", WM8900_REG_POWER2, 2, 0,
|
||
|
wm8900_rinpga_controls,
|
||
|
ARRAY_SIZE(wm8900_rinpga_controls)),
|
||
|
|
||
|
SND_SOC_DAPM_MIXER("Left Input Mixer", WM8900_REG_POWER2, 5, 0,
|
||
|
wm8900_linmix_controls,
|
||
|
ARRAY_SIZE(wm8900_linmix_controls)),
|
||
|
SND_SOC_DAPM_MIXER("Right Input Mixer", WM8900_REG_POWER2, 4, 0,
|
||
|
wm8900_rinmix_controls,
|
||
|
ARRAY_SIZE(wm8900_rinmix_controls)),
|
||
|
|
||
|
SND_SOC_DAPM_MICBIAS("Mic Bias", WM8900_REG_POWER1, 4, 0),
|
||
|
|
||
|
SND_SOC_DAPM_ADC("ADCL", "Left HiFi Capture", WM8900_REG_POWER2, 1, 0),
|
||
|
SND_SOC_DAPM_ADC("ADCR", "Right HiFi Capture", WM8900_REG_POWER2, 0, 0),
|
||
|
|
||
|
/* Output */
|
||
|
SND_SOC_DAPM_DAC("DACL", "Left HiFi Playback", WM8900_REG_POWER3, 1, 0),
|
||
|
SND_SOC_DAPM_DAC("DACR", "Right HiFi Playback", WM8900_REG_POWER3, 0, 0),
|
||
|
|
||
|
SND_SOC_DAPM_PGA_E("Headphone Amplifier", WM8900_REG_POWER3, 7, 0, NULL, 0,
|
||
|
wm8900_hp_event,
|
||
|
SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
|
||
|
SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
|
||
|
|
||
|
SND_SOC_DAPM_PGA("LINEOUT1L PGA", WM8900_REG_POWER2, 8, 0, NULL, 0),
|
||
|
SND_SOC_DAPM_PGA("LINEOUT1R PGA", WM8900_REG_POWER2, 7, 0, NULL, 0),
|
||
|
|
||
|
SND_SOC_DAPM_MUX("LINEOUT2 LP", SND_SOC_NOPM, 0, 0, &wm8900_lineout2_lp),
|
||
|
SND_SOC_DAPM_PGA("LINEOUT2L PGA", WM8900_REG_POWER3, 6, 0, NULL, 0),
|
||
|
SND_SOC_DAPM_PGA("LINEOUT2R PGA", WM8900_REG_POWER3, 5, 0, NULL, 0),
|
||
|
|
||
|
SND_SOC_DAPM_MIXER("Left Output Mixer", WM8900_REG_POWER3, 3, 0,
|
||
|
wm8900_loutmix_controls,
|
||
|
ARRAY_SIZE(wm8900_loutmix_controls)),
|
||
|
SND_SOC_DAPM_MIXER("Right Output Mixer", WM8900_REG_POWER3, 2, 0,
|
||
|
wm8900_routmix_controls,
|
||
|
ARRAY_SIZE(wm8900_routmix_controls)),
|
||
|
};
|
||
|
|
||
|
/* Target, Path, Source */
|
||
|
static const struct snd_soc_dapm_route audio_map[] = {
|
||
|
/* Inputs */
|
||
|
{"Left Input PGA", "LINPUT1 Switch", "LINPUT1"},
|
||
|
{"Left Input PGA", "LINPUT2 Switch", "LINPUT2"},
|
||
|
{"Left Input PGA", "LINPUT3 Switch", "LINPUT3"},
|
||
|
|
||
|
{"Right Input PGA", "RINPUT1 Switch", "RINPUT1"},
|
||
|
{"Right Input PGA", "RINPUT2 Switch", "RINPUT2"},
|
||
|
{"Right Input PGA", "RINPUT3 Switch", "RINPUT3"},
|
||
|
|
||
|
{"Left Input Mixer", "LINPUT2 Switch", "LINPUT2"},
|
||
|
{"Left Input Mixer", "LINPUT3 Switch", "LINPUT3"},
|
||
|
{"Left Input Mixer", "AUX Switch", "AUX"},
|
||
|
{"Left Input Mixer", "Input PGA Switch", "Left Input PGA"},
|
||
|
|
||
|
{"Right Input Mixer", "RINPUT2 Switch", "RINPUT2"},
|
||
|
{"Right Input Mixer", "RINPUT3 Switch", "RINPUT3"},
|
||
|
{"Right Input Mixer", "AUX Switch", "AUX"},
|
||
|
{"Right Input Mixer", "Input PGA Switch", "Right Input PGA"},
|
||
|
|
||
|
{"ADCL", NULL, "Left Input Mixer"},
|
||
|
{"ADCR", NULL, "Right Input Mixer"},
|
||
|
|
||
|
/* Outputs */
|
||
|
{"LINEOUT1L", NULL, "LINEOUT1L PGA"},
|
||
|
{"LINEOUT1L PGA", NULL, "Left Output Mixer"},
|
||
|
{"LINEOUT1R", NULL, "LINEOUT1R PGA"},
|
||
|
{"LINEOUT1R PGA", NULL, "Right Output Mixer"},
|
||
|
|
||
|
{"LINEOUT2L PGA", NULL, "Left Output Mixer"},
|
||
|
{"LINEOUT2 LP", "Disabled", "LINEOUT2L PGA"},
|
||
|
{"LINEOUT2 LP", "Enabled", "Left Output Mixer"},
|
||
|
{"LINEOUT2L", NULL, "LINEOUT2 LP"},
|
||
|
|
||
|
{"LINEOUT2R PGA", NULL, "Right Output Mixer"},
|
||
|
{"LINEOUT2 LP", "Disabled", "LINEOUT2R PGA"},
|
||
|
{"LINEOUT2 LP", "Enabled", "Right Output Mixer"},
|
||
|
{"LINEOUT2R", NULL, "LINEOUT2 LP"},
|
||
|
|
||
|
{"Left Output Mixer", "LINPUT3 Bypass Switch", "LINPUT3"},
|
||
|
{"Left Output Mixer", "AUX Bypass Switch", "AUX"},
|
||
|
{"Left Output Mixer", "Left Input Mixer Switch", "Left Input Mixer"},
|
||
|
{"Left Output Mixer", "Right Input Mixer Switch", "Right Input Mixer"},
|
||
|
{"Left Output Mixer", "DACL Switch", "DACL"},
|
||
|
|
||
|
{"Right Output Mixer", "RINPUT3 Bypass Switch", "RINPUT3"},
|
||
|
{"Right Output Mixer", "AUX Bypass Switch", "AUX"},
|
||
|
{"Right Output Mixer", "Left Input Mixer Switch", "Left Input Mixer"},
|
||
|
{"Right Output Mixer", "Right Input Mixer Switch", "Right Input Mixer"},
|
||
|
{"Right Output Mixer", "DACR Switch", "DACR"},
|
||
|
|
||
|
/* Note that the headphone output stage needs to be connected
|
||
|
* externally to LINEOUT2 via DC blocking capacitors. Other
|
||
|
* configurations are not supported.
|
||
|
*
|
||
|
* Note also that left and right headphone paths are treated as a
|
||
|
* mono path.
|
||
|
*/
|
||
|
{"Headphone Amplifier", NULL, "LINEOUT2 LP"},
|
||
|
{"Headphone Amplifier", NULL, "LINEOUT2 LP"},
|
||
|
{"HP_L", NULL, "Headphone Amplifier"},
|
||
|
{"HP_R", NULL, "Headphone Amplifier"},
|
||
|
};
|
||
|
|
||
|
static int wm8900_add_widgets(struct snd_soc_codec *codec)
|
||
|
{
|
||
|
snd_soc_dapm_new_controls(codec, wm8900_dapm_widgets,
|
||
|
ARRAY_SIZE(wm8900_dapm_widgets));
|
||
|
|
||
|
snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
|
||
|
|
||
|
snd_soc_dapm_new_widgets(codec);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int wm8900_hw_params(struct snd_pcm_substream *substream,
|
||
|
struct snd_pcm_hw_params *params)
|
||
|
{
|
||
|
struct snd_soc_pcm_runtime *rtd = substream->private_data;
|
||
|
struct snd_soc_device *socdev = rtd->socdev;
|
||
|
struct snd_soc_codec *codec = socdev->codec;
|
||
|
u16 reg;
|
||
|
|
||
|
reg = wm8900_read(codec, WM8900_REG_AUDIO1) & ~0x60;
|
||
|
|
||
|
switch (params_format(params)) {
|
||
|
case SNDRV_PCM_FORMAT_S16_LE:
|
||
|
break;
|
||
|
case SNDRV_PCM_FORMAT_S20_3LE:
|
||
|
reg |= 0x20;
|
||
|
break;
|
||
|
case SNDRV_PCM_FORMAT_S24_LE:
|
||
|
reg |= 0x40;
|
||
|
break;
|
||
|
case SNDRV_PCM_FORMAT_S32_LE:
|
||
|
reg |= 0x60;
|
||
|
break;
|
||
|
default:
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
wm8900_write(codec, WM8900_REG_AUDIO1, reg);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/* FLL divisors */
|
||
|
struct _fll_div {
|
||
|
u16 fll_ratio;
|
||
|
u16 fllclk_div;
|
||
|
u16 fll_slow_lock_ref;
|
||
|
u16 n;
|
||
|
u16 k;
|
||
|
};
|
||
|
|
||
|
/* The size in bits of the FLL divide multiplied by 10
|
||
|
* to allow rounding later */
|
||
|
#define FIXED_FLL_SIZE ((1 << 16) * 10)
|
||
|
|
||
|
static int fll_factors(struct _fll_div *fll_div, unsigned int Fref,
|
||
|
unsigned int Fout)
|
||
|
{
|
||
|
u64 Kpart;
|
||
|
unsigned int K, Ndiv, Nmod, target;
|
||
|
unsigned int div;
|
||
|
|
||
|
BUG_ON(!Fout);
|
||
|
|
||
|
/* The FLL must run at 90-100MHz which is then scaled down to
|
||
|
* the output value by FLLCLK_DIV. */
|
||
|
target = Fout;
|
||
|
div = 1;
|
||
|
while (target < 90000000) {
|
||
|
div *= 2;
|
||
|
target *= 2;
|
||
|
}
|
||
|
|
||
|
if (target > 100000000)
|
||
|
printk(KERN_WARNING "wm8900: FLL rate %d out of range, Fref=%d"
|
||
|
" Fout=%d\n", target, Fref, Fout);
|
||
|
if (div > 32) {
|
||
|
printk(KERN_ERR "wm8900: Invalid FLL division rate %u, "
|
||
|
"Fref=%d, Fout=%d, target=%d\n",
|
||
|
div, Fref, Fout, target);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
fll_div->fllclk_div = div >> 2;
|
||
|
|
||
|
if (Fref < 48000)
|
||
|
fll_div->fll_slow_lock_ref = 1;
|
||
|
else
|
||
|
fll_div->fll_slow_lock_ref = 0;
|
||
|
|
||
|
Ndiv = target / Fref;
|
||
|
|
||
|
if (Fref < 1000000)
|
||
|
fll_div->fll_ratio = 8;
|
||
|
else
|
||
|
fll_div->fll_ratio = 1;
|
||
|
|
||
|
fll_div->n = Ndiv / fll_div->fll_ratio;
|
||
|
Nmod = (target / fll_div->fll_ratio) % Fref;
|
||
|
|
||
|
/* Calculate fractional part - scale up so we can round. */
|
||
|
Kpart = FIXED_FLL_SIZE * (long long)Nmod;
|
||
|
|
||
|
do_div(Kpart, Fref);
|
||
|
|
||
|
K = Kpart & 0xFFFFFFFF;
|
||
|
|
||
|
if ((K % 10) >= 5)
|
||
|
K += 5;
|
||
|
|
||
|
/* Move down to proper range now rounding is done */
|
||
|
fll_div->k = K / 10;
|
||
|
|
||
|
BUG_ON(target != Fout * (fll_div->fllclk_div << 2));
|
||
|
BUG_ON(!K && target != Fref * fll_div->fll_ratio * fll_div->n);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int wm8900_set_fll(struct snd_soc_codec *codec,
|
||
|
int fll_id, unsigned int freq_in, unsigned int freq_out)
|
||
|
{
|
||
|
struct wm8900_priv *wm8900 = codec->private_data;
|
||
|
struct _fll_div fll_div;
|
||
|
unsigned int reg;
|
||
|
|
||
|
if (wm8900->fll_in == freq_in && wm8900->fll_out == freq_out)
|
||
|
return 0;
|
||
|
|
||
|
/* The digital side should be disabled during any change. */
|
||
|
reg = wm8900_read(codec, WM8900_REG_POWER1);
|
||
|
wm8900_write(codec, WM8900_REG_POWER1,
|
||
|
reg & (~WM8900_REG_POWER1_FLL_ENA));
|
||
|
|
||
|
/* Disable the FLL? */
|
||
|
if (!freq_in || !freq_out) {
|
||
|
reg = wm8900_read(codec, WM8900_REG_CLOCKING1);
|
||
|
wm8900_write(codec, WM8900_REG_CLOCKING1,
|
||
|
reg & (~WM8900_REG_CLOCKING1_MCLK_SRC));
|
||
|
|
||
|
reg = wm8900_read(codec, WM8900_REG_FLLCTL1);
|
||
|
wm8900_write(codec, WM8900_REG_FLLCTL1,
|
||
|
reg & (~WM8900_REG_FLLCTL1_OSC_ENA));
|
||
|
|
||
|
wm8900->fll_in = freq_in;
|
||
|
wm8900->fll_out = freq_out;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
if (fll_factors(&fll_div, freq_in, freq_out) != 0)
|
||
|
goto reenable;
|
||
|
|
||
|
wm8900->fll_in = freq_in;
|
||
|
wm8900->fll_out = freq_out;
|
||
|
|
||
|
/* The osclilator *MUST* be enabled before we enable the
|
||
|
* digital circuit. */
|
||
|
wm8900_write(codec, WM8900_REG_FLLCTL1,
|
||
|
fll_div.fll_ratio | WM8900_REG_FLLCTL1_OSC_ENA);
|
||
|
|
||
|
wm8900_write(codec, WM8900_REG_FLLCTL4, fll_div.n >> 5);
|
||
|
wm8900_write(codec, WM8900_REG_FLLCTL5,
|
||
|
(fll_div.fllclk_div << 6) | (fll_div.n & 0x1f));
|
||
|
|
||
|
if (fll_div.k) {
|
||
|
wm8900_write(codec, WM8900_REG_FLLCTL2,
|
||
|
(fll_div.k >> 8) | 0x100);
|
||
|
wm8900_write(codec, WM8900_REG_FLLCTL3, fll_div.k & 0xff);
|
||
|
} else
|
||
|
wm8900_write(codec, WM8900_REG_FLLCTL2, 0);
|
||
|
|
||
|
if (fll_div.fll_slow_lock_ref)
|
||
|
wm8900_write(codec, WM8900_REG_FLLCTL6,
|
||
|
WM8900_REG_FLLCTL6_FLL_SLOW_LOCK_REF);
|
||
|
else
|
||
|
wm8900_write(codec, WM8900_REG_FLLCTL6, 0);
|
||
|
|
||
|
reg = wm8900_read(codec, WM8900_REG_POWER1);
|
||
|
wm8900_write(codec, WM8900_REG_POWER1,
|
||
|
reg | WM8900_REG_POWER1_FLL_ENA);
|
||
|
|
||
|
reenable:
|
||
|
reg = wm8900_read(codec, WM8900_REG_CLOCKING1);
|
||
|
wm8900_write(codec, WM8900_REG_CLOCKING1,
|
||
|
reg | WM8900_REG_CLOCKING1_MCLK_SRC);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int wm8900_set_dai_pll(struct snd_soc_dai *codec_dai,
|
||
|
int pll_id, unsigned int freq_in, unsigned int freq_out)
|
||
|
{
|
||
|
return wm8900_set_fll(codec_dai->codec, pll_id, freq_in, freq_out);
|
||
|
}
|
||
|
|
||
|
static int wm8900_set_dai_clkdiv(struct snd_soc_dai *codec_dai,
|
||
|
int div_id, int div)
|
||
|
{
|
||
|
struct snd_soc_codec *codec = codec_dai->codec;
|
||
|
unsigned int reg;
|
||
|
|
||
|
switch (div_id) {
|
||
|
case WM8900_BCLK_DIV:
|
||
|
reg = wm8900_read(codec, WM8900_REG_CLOCKING1);
|
||
|
wm8900_write(codec, WM8900_REG_CLOCKING1,
|
||
|
div | (reg & WM8900_REG_CLOCKING1_BCLK_MASK));
|
||
|
break;
|
||
|
case WM8900_OPCLK_DIV:
|
||
|
reg = wm8900_read(codec, WM8900_REG_CLOCKING1);
|
||
|
wm8900_write(codec, WM8900_REG_CLOCKING1,
|
||
|
div | (reg & WM8900_REG_CLOCKING1_OPCLK_MASK));
|
||
|
break;
|
||
|
case WM8900_DAC_LRCLK:
|
||
|
reg = wm8900_read(codec, WM8900_REG_AUDIO4);
|
||
|
wm8900_write(codec, WM8900_REG_AUDIO4,
|
||
|
div | (reg & WM8900_LRC_MASK));
|
||
|
break;
|
||
|
case WM8900_ADC_LRCLK:
|
||
|
reg = wm8900_read(codec, WM8900_REG_AUDIO3);
|
||
|
wm8900_write(codec, WM8900_REG_AUDIO3,
|
||
|
div | (reg & WM8900_LRC_MASK));
|
||
|
break;
|
||
|
case WM8900_DAC_CLKDIV:
|
||
|
reg = wm8900_read(codec, WM8900_REG_CLOCKING2);
|
||
|
wm8900_write(codec, WM8900_REG_CLOCKING2,
|
||
|
div | (reg & WM8900_REG_CLOCKING2_DAC_CLKDIV));
|
||
|
break;
|
||
|
case WM8900_ADC_CLKDIV:
|
||
|
reg = wm8900_read(codec, WM8900_REG_CLOCKING2);
|
||
|
wm8900_write(codec, WM8900_REG_CLOCKING2,
|
||
|
div | (reg & WM8900_REG_CLOCKING2_ADC_CLKDIV));
|
||
|
break;
|
||
|
case WM8900_LRCLK_MODE:
|
||
|
reg = wm8900_read(codec, WM8900_REG_DACCTRL);
|
||
|
wm8900_write(codec, WM8900_REG_DACCTRL,
|
||
|
div | (reg & WM8900_REG_DACCTRL_AIF_LRCLKRATE));
|
||
|
break;
|
||
|
default:
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
|
||
|
static int wm8900_set_dai_fmt(struct snd_soc_dai *codec_dai,
|
||
|
unsigned int fmt)
|
||
|
{
|
||
|
struct snd_soc_codec *codec = codec_dai->codec;
|
||
|
unsigned int clocking1, aif1, aif3, aif4;
|
||
|
|
||
|
clocking1 = wm8900_read(codec, WM8900_REG_CLOCKING1);
|
||
|
aif1 = wm8900_read(codec, WM8900_REG_AUDIO1);
|
||
|
aif3 = wm8900_read(codec, WM8900_REG_AUDIO3);
|
||
|
aif4 = wm8900_read(codec, WM8900_REG_AUDIO4);
|
||
|
|
||
|
/* set master/slave audio interface */
|
||
|
switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
|
||
|
case SND_SOC_DAIFMT_CBS_CFS:
|
||
|
clocking1 &= ~WM8900_REG_CLOCKING1_BCLK_DIR;
|
||
|
aif3 &= ~WM8900_REG_AUDIO3_ADCLRC_DIR;
|
||
|
aif4 &= ~WM8900_REG_AUDIO4_DACLRC_DIR;
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_CBS_CFM:
|
||
|
clocking1 &= ~WM8900_REG_CLOCKING1_BCLK_DIR;
|
||
|
aif3 |= WM8900_REG_AUDIO3_ADCLRC_DIR;
|
||
|
aif4 |= WM8900_REG_AUDIO4_DACLRC_DIR;
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_CBM_CFM:
|
||
|
clocking1 |= WM8900_REG_CLOCKING1_BCLK_DIR;
|
||
|
aif3 |= WM8900_REG_AUDIO3_ADCLRC_DIR;
|
||
|
aif4 |= WM8900_REG_AUDIO4_DACLRC_DIR;
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_CBM_CFS:
|
||
|
clocking1 |= WM8900_REG_CLOCKING1_BCLK_DIR;
|
||
|
aif3 &= ~WM8900_REG_AUDIO3_ADCLRC_DIR;
|
||
|
aif4 &= ~WM8900_REG_AUDIO4_DACLRC_DIR;
|
||
|
break;
|
||
|
default:
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
|
||
|
case SND_SOC_DAIFMT_DSP_A:
|
||
|
aif1 |= WM8900_REG_AUDIO1_AIF_FMT_MASK;
|
||
|
aif1 &= ~WM8900_REG_AUDIO1_LRCLK_INV;
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_DSP_B:
|
||
|
aif1 |= WM8900_REG_AUDIO1_AIF_FMT_MASK;
|
||
|
aif1 |= WM8900_REG_AUDIO1_LRCLK_INV;
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_I2S:
|
||
|
aif1 &= ~WM8900_REG_AUDIO1_AIF_FMT_MASK;
|
||
|
aif1 |= 0x10;
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_RIGHT_J:
|
||
|
aif1 &= ~WM8900_REG_AUDIO1_AIF_FMT_MASK;
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_LEFT_J:
|
||
|
aif1 &= ~WM8900_REG_AUDIO1_AIF_FMT_MASK;
|
||
|
aif1 |= 0x8;
|
||
|
break;
|
||
|
default:
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
/* Clock inversion */
|
||
|
switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
|
||
|
case SND_SOC_DAIFMT_DSP_A:
|
||
|
case SND_SOC_DAIFMT_DSP_B:
|
||
|
/* frame inversion not valid for DSP modes */
|
||
|
switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
|
||
|
case SND_SOC_DAIFMT_NB_NF:
|
||
|
aif1 &= ~WM8900_REG_AUDIO1_BCLK_INV;
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_IB_NF:
|
||
|
aif1 |= WM8900_REG_AUDIO1_BCLK_INV;
|
||
|
break;
|
||
|
default:
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_I2S:
|
||
|
case SND_SOC_DAIFMT_RIGHT_J:
|
||
|
case SND_SOC_DAIFMT_LEFT_J:
|
||
|
switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
|
||
|
case SND_SOC_DAIFMT_NB_NF:
|
||
|
aif1 &= ~WM8900_REG_AUDIO1_BCLK_INV;
|
||
|
aif1 &= ~WM8900_REG_AUDIO1_LRCLK_INV;
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_IB_IF:
|
||
|
aif1 |= WM8900_REG_AUDIO1_BCLK_INV;
|
||
|
aif1 |= WM8900_REG_AUDIO1_LRCLK_INV;
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_IB_NF:
|
||
|
aif1 |= WM8900_REG_AUDIO1_BCLK_INV;
|
||
|
aif1 &= ~WM8900_REG_AUDIO1_LRCLK_INV;
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_NB_IF:
|
||
|
aif1 &= ~WM8900_REG_AUDIO1_BCLK_INV;
|
||
|
aif1 |= WM8900_REG_AUDIO1_LRCLK_INV;
|
||
|
break;
|
||
|
default:
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
break;
|
||
|
default:
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
wm8900_write(codec, WM8900_REG_CLOCKING1, clocking1);
|
||
|
wm8900_write(codec, WM8900_REG_AUDIO1, aif1);
|
||
|
wm8900_write(codec, WM8900_REG_AUDIO3, aif3);
|
||
|
wm8900_write(codec, WM8900_REG_AUDIO4, aif4);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int wm8900_digital_mute(struct snd_soc_dai *codec_dai, int mute)
|
||
|
{
|
||
|
struct snd_soc_codec *codec = codec_dai->codec;
|
||
|
u16 reg;
|
||
|
|
||
|
reg = wm8900_read(codec, WM8900_REG_DACCTRL);
|
||
|
|
||
|
if (mute)
|
||
|
reg |= WM8900_REG_DACCTRL_MUTE;
|
||
|
else
|
||
|
reg &= ~WM8900_REG_DACCTRL_MUTE;
|
||
|
|
||
|
wm8900_write(codec, WM8900_REG_DACCTRL, reg);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
#define WM8900_RATES (SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_11025 |\
|
||
|
SNDRV_PCM_RATE_16000 | SNDRV_PCM_RATE_22050 |\
|
||
|
SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000)
|
||
|
|
||
|
#define WM8900_PCM_FORMATS \
|
||
|
(SNDRV_PCM_FORMAT_S16_LE | SNDRV_PCM_FORMAT_S20_3LE | \
|
||
|
SNDRV_PCM_FORMAT_S24_LE)
|
||
|
|
||
|
struct snd_soc_dai wm8900_dai = {
|
||
|
.name = "WM8900 HiFi",
|
||
|
.playback = {
|
||
|
.stream_name = "HiFi Playback",
|
||
|
.channels_min = 1,
|
||
|
.channels_max = 2,
|
||
|
.rates = WM8900_RATES,
|
||
|
.formats = WM8900_PCM_FORMATS,
|
||
|
},
|
||
|
.capture = {
|
||
|
.stream_name = "HiFi Capture",
|
||
|
.channels_min = 1,
|
||
|
.channels_max = 2,
|
||
|
.rates = WM8900_RATES,
|
||
|
.formats = WM8900_PCM_FORMATS,
|
||
|
},
|
||
|
.ops = {
|
||
|
.hw_params = wm8900_hw_params,
|
||
|
},
|
||
|
.dai_ops = {
|
||
|
.set_clkdiv = wm8900_set_dai_clkdiv,
|
||
|
.set_pll = wm8900_set_dai_pll,
|
||
|
.set_fmt = wm8900_set_dai_fmt,
|
||
|
.digital_mute = wm8900_digital_mute,
|
||
|
},
|
||
|
};
|
||
|
EXPORT_SYMBOL_GPL(wm8900_dai);
|
||
|
|
||
|
static int wm8900_set_bias_level(struct snd_soc_codec *codec,
|
||
|
enum snd_soc_bias_level level)
|
||
|
{
|
||
|
u16 reg;
|
||
|
|
||
|
switch (level) {
|
||
|
case SND_SOC_BIAS_ON:
|
||
|
/* Enable thermal shutdown */
|
||
|
reg = wm8900_read(codec, WM8900_REG_GPIO);
|
||
|
wm8900_write(codec, WM8900_REG_GPIO,
|
||
|
reg | WM8900_REG_GPIO_TEMP_ENA);
|
||
|
reg = wm8900_read(codec, WM8900_REG_ADDCTL);
|
||
|
wm8900_write(codec, WM8900_REG_ADDCTL,
|
||
|
reg | WM8900_REG_ADDCTL_TEMP_SD);
|
||
|
break;
|
||
|
|
||
|
case SND_SOC_BIAS_PREPARE:
|
||
|
break;
|
||
|
|
||
|
case SND_SOC_BIAS_STANDBY:
|
||
|
/* Charge capacitors if initial power up */
|
||
|
if (codec->bias_level == SND_SOC_BIAS_OFF) {
|
||
|
/* STARTUP_BIAS_ENA on */
|
||
|
wm8900_write(codec, WM8900_REG_POWER1,
|
||
|
WM8900_REG_POWER1_STARTUP_BIAS_ENA);
|
||
|
|
||
|
/* Startup bias mode */
|
||
|
wm8900_write(codec, WM8900_REG_ADDCTL,
|
||
|
WM8900_REG_ADDCTL_BIAS_SRC |
|
||
|
WM8900_REG_ADDCTL_VMID_SOFTST);
|
||
|
|
||
|
/* VMID 2x50k */
|
||
|
wm8900_write(codec, WM8900_REG_POWER1,
|
||
|
WM8900_REG_POWER1_STARTUP_BIAS_ENA | 0x1);
|
||
|
|
||
|
/* Allow capacitors to charge */
|
||
|
schedule_timeout_interruptible(msecs_to_jiffies(400));
|
||
|
|
||
|
/* Enable bias */
|
||
|
wm8900_write(codec, WM8900_REG_POWER1,
|
||
|
WM8900_REG_POWER1_STARTUP_BIAS_ENA |
|
||
|
WM8900_REG_POWER1_BIAS_ENA | 0x1);
|
||
|
|
||
|
wm8900_write(codec, WM8900_REG_ADDCTL, 0);
|
||
|
|
||
|
wm8900_write(codec, WM8900_REG_POWER1,
|
||
|
WM8900_REG_POWER1_BIAS_ENA | 0x1);
|
||
|
}
|
||
|
|
||
|
reg = wm8900_read(codec, WM8900_REG_POWER1);
|
||
|
wm8900_write(codec, WM8900_REG_POWER1,
|
||
|
(reg & WM8900_REG_POWER1_FLL_ENA) |
|
||
|
WM8900_REG_POWER1_BIAS_ENA | 0x1);
|
||
|
wm8900_write(codec, WM8900_REG_POWER2,
|
||
|
WM8900_REG_POWER2_SYSCLK_ENA);
|
||
|
wm8900_write(codec, WM8900_REG_POWER3, 0);
|
||
|
break;
|
||
|
|
||
|
case SND_SOC_BIAS_OFF:
|
||
|
/* Startup bias enable */
|
||
|
reg = wm8900_read(codec, WM8900_REG_POWER1);
|
||
|
wm8900_write(codec, WM8900_REG_POWER1,
|
||
|
reg & WM8900_REG_POWER1_STARTUP_BIAS_ENA);
|
||
|
wm8900_write(codec, WM8900_REG_ADDCTL,
|
||
|
WM8900_REG_ADDCTL_BIAS_SRC |
|
||
|
WM8900_REG_ADDCTL_VMID_SOFTST);
|
||
|
|
||
|
/* Discharge caps */
|
||
|
wm8900_write(codec, WM8900_REG_POWER1,
|
||
|
WM8900_REG_POWER1_STARTUP_BIAS_ENA);
|
||
|
schedule_timeout_interruptible(msecs_to_jiffies(500));
|
||
|
|
||
|
/* Remove clamp */
|
||
|
wm8900_write(codec, WM8900_REG_HPCTL1, 0);
|
||
|
|
||
|
/* Power down */
|
||
|
wm8900_write(codec, WM8900_REG_ADDCTL, 0);
|
||
|
wm8900_write(codec, WM8900_REG_POWER1, 0);
|
||
|
wm8900_write(codec, WM8900_REG_POWER2, 0);
|
||
|
wm8900_write(codec, WM8900_REG_POWER3, 0);
|
||
|
|
||
|
/* Need to let things settle before stopping the clock
|
||
|
* to ensure that restart works, see "Stopping the
|
||
|
* master clock" in the datasheet. */
|
||
|
schedule_timeout_interruptible(msecs_to_jiffies(1));
|
||
|
wm8900_write(codec, WM8900_REG_POWER2,
|
||
|
WM8900_REG_POWER2_SYSCLK_ENA);
|
||
|
break;
|
||
|
}
|
||
|
codec->bias_level = level;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int wm8900_suspend(struct platform_device *pdev, pm_message_t state)
|
||
|
{
|
||
|
struct snd_soc_device *socdev = platform_get_drvdata(pdev);
|
||
|
struct snd_soc_codec *codec = socdev->codec;
|
||
|
struct wm8900_priv *wm8900 = codec->private_data;
|
||
|
int fll_out = wm8900->fll_out;
|
||
|
int fll_in = wm8900->fll_in;
|
||
|
int ret;
|
||
|
|
||
|
/* Stop the FLL in an orderly fashion */
|
||
|
ret = wm8900_set_fll(codec, 0, 0, 0);
|
||
|
if (ret != 0) {
|
||
|
dev_err(&pdev->dev, "Failed to stop FLL\n");
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
wm8900->fll_out = fll_out;
|
||
|
wm8900->fll_in = fll_in;
|
||
|
|
||
|
wm8900_set_bias_level(codec, SND_SOC_BIAS_OFF);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int wm8900_resume(struct platform_device *pdev)
|
||
|
{
|
||
|
struct snd_soc_device *socdev = platform_get_drvdata(pdev);
|
||
|
struct snd_soc_codec *codec = socdev->codec;
|
||
|
struct wm8900_priv *wm8900 = codec->private_data;
|
||
|
u16 *cache;
|
||
|
int i, ret;
|
||
|
|
||
|
cache = kmemdup(codec->reg_cache, sizeof(wm8900_reg_defaults),
|
||
|
GFP_KERNEL);
|
||
|
|
||
|
wm8900_reset(codec);
|
||
|
wm8900_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
|
||
|
|
||
|
/* Restart the FLL? */
|
||
|
if (wm8900->fll_out) {
|
||
|
int fll_out = wm8900->fll_out;
|
||
|
int fll_in = wm8900->fll_in;
|
||
|
|
||
|
wm8900->fll_in = 0;
|
||
|
wm8900->fll_out = 0;
|
||
|
|
||
|
ret = wm8900_set_fll(codec, 0, fll_in, fll_out);
|
||
|
if (ret != 0) {
|
||
|
dev_err(&pdev->dev, "Failed to restart FLL\n");
|
||
|
return ret;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (cache) {
|
||
|
for (i = 0; i < WM8900_MAXREG; i++)
|
||
|
wm8900_write(codec, i, cache[i]);
|
||
|
kfree(cache);
|
||
|
} else
|
||
|
dev_err(&pdev->dev, "Unable to allocate register cache\n");
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* initialise the WM8900 driver
|
||
|
* register the mixer and dsp interfaces with the kernel
|
||
|
*/
|
||
|
static int wm8900_init(struct snd_soc_device *socdev)
|
||
|
{
|
||
|
struct snd_soc_codec *codec = socdev->codec;
|
||
|
int ret = 0;
|
||
|
unsigned int reg;
|
||
|
struct i2c_client *i2c_client = socdev->codec->control_data;
|
||
|
|
||
|
codec->name = "WM8900";
|
||
|
codec->owner = THIS_MODULE;
|
||
|
codec->read = wm8900_read;
|
||
|
codec->write = wm8900_write;
|
||
|
codec->dai = &wm8900_dai;
|
||
|
codec->num_dai = 1;
|
||
|
codec->reg_cache_size = WM8900_MAXREG;
|
||
|
codec->reg_cache = kmemdup(wm8900_reg_defaults,
|
||
|
sizeof(wm8900_reg_defaults), GFP_KERNEL);
|
||
|
|
||
|
if (codec->reg_cache == NULL)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
reg = wm8900_read(codec, WM8900_REG_ID);
|
||
|
if (reg != 0x8900) {
|
||
|
dev_err(&i2c_client->dev, "Device is not a WM8900 - ID %x\n",
|
||
|
reg);
|
||
|
return -ENODEV;
|
||
|
}
|
||
|
|
||
|
codec->private_data = kzalloc(sizeof(struct wm8900_priv), GFP_KERNEL);
|
||
|
if (codec->private_data == NULL) {
|
||
|
ret = -ENOMEM;
|
||
|
goto priv_err;
|
||
|
}
|
||
|
|
||
|
/* Read back from the chip */
|
||
|
reg = wm8900_chip_read(codec, WM8900_REG_POWER1);
|
||
|
reg = (reg >> 12) & 0xf;
|
||
|
dev_info(&i2c_client->dev, "WM8900 revision %d\n", reg);
|
||
|
|
||
|
wm8900_reset(codec);
|
||
|
|
||
|
/* Latch the volume update bits */
|
||
|
wm8900_write(codec, WM8900_REG_LINVOL,
|
||
|
wm8900_read(codec, WM8900_REG_LINVOL) | 0x100);
|
||
|
wm8900_write(codec, WM8900_REG_RINVOL,
|
||
|
wm8900_read(codec, WM8900_REG_RINVOL) | 0x100);
|
||
|
wm8900_write(codec, WM8900_REG_LOUT1CTL,
|
||
|
wm8900_read(codec, WM8900_REG_LOUT1CTL) | 0x100);
|
||
|
wm8900_write(codec, WM8900_REG_ROUT1CTL,
|
||
|
wm8900_read(codec, WM8900_REG_ROUT1CTL) | 0x100);
|
||
|
wm8900_write(codec, WM8900_REG_LOUT2CTL,
|
||
|
wm8900_read(codec, WM8900_REG_LOUT2CTL) | 0x100);
|
||
|
wm8900_write(codec, WM8900_REG_ROUT2CTL,
|
||
|
wm8900_read(codec, WM8900_REG_ROUT2CTL) | 0x100);
|
||
|
wm8900_write(codec, WM8900_REG_LDAC_DV,
|
||
|
wm8900_read(codec, WM8900_REG_LDAC_DV) | 0x100);
|
||
|
wm8900_write(codec, WM8900_REG_RDAC_DV,
|
||
|
wm8900_read(codec, WM8900_REG_RDAC_DV) | 0x100);
|
||
|
wm8900_write(codec, WM8900_REG_LADC_DV,
|
||
|
wm8900_read(codec, WM8900_REG_LADC_DV) | 0x100);
|
||
|
wm8900_write(codec, WM8900_REG_RADC_DV,
|
||
|
wm8900_read(codec, WM8900_REG_RADC_DV) | 0x100);
|
||
|
|
||
|
/* Set the DAC and mixer output bias */
|
||
|
wm8900_write(codec, WM8900_REG_OUTBIASCTL, 0x81);
|
||
|
|
||
|
/* Register pcms */
|
||
|
ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
|
||
|
if (ret < 0) {
|
||
|
dev_err(&i2c_client->dev, "Failed to register new PCMs\n");
|
||
|
goto pcm_err;
|
||
|
}
|
||
|
|
||
|
/* Turn the chip on */
|
||
|
codec->bias_level = SND_SOC_BIAS_OFF;
|
||
|
wm8900_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
|
||
|
|
||
|
wm8900_add_controls(codec);
|
||
|
wm8900_add_widgets(codec);
|
||
|
|
||
|
ret = snd_soc_register_card(socdev);
|
||
|
if (ret < 0) {
|
||
|
dev_err(&i2c_client->dev, "Failed to register card\n");
|
||
|
goto card_err;
|
||
|
}
|
||
|
return ret;
|
||
|
|
||
|
card_err:
|
||
|
snd_soc_free_pcms(socdev);
|
||
|
snd_soc_dapm_free(socdev);
|
||
|
pcm_err:
|
||
|
kfree(codec->reg_cache);
|
||
|
priv_err:
|
||
|
kfree(codec->private_data);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static struct snd_soc_device *wm8900_socdev;
|
||
|
|
||
|
#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
|
||
|
|
||
|
static unsigned short normal_i2c[] = { 0, I2C_CLIENT_END };
|
||
|
|
||
|
/* Magic definition of all other variables and things */
|
||
|
I2C_CLIENT_INSMOD;
|
||
|
|
||
|
static struct i2c_driver wm8900_i2c_driver;
|
||
|
static struct i2c_client client_template;
|
||
|
|
||
|
/* If the i2c layer weren't so broken, we could pass this kind of data
|
||
|
around */
|
||
|
static int wm8900_codec_probe(struct i2c_adapter *adap, int addr, int kind)
|
||
|
{
|
||
|
struct snd_soc_device *socdev = wm8900_socdev;
|
||
|
struct wm8900_setup_data *setup = socdev->codec_data;
|
||
|
struct snd_soc_codec *codec = socdev->codec;
|
||
|
struct i2c_client *i2c;
|
||
|
int ret;
|
||
|
|
||
|
if (addr != setup->i2c_address)
|
||
|
return -ENODEV;
|
||
|
|
||
|
dev_err(&adap->dev, "Probe on %x\n", addr);
|
||
|
|
||
|
client_template.adapter = adap;
|
||
|
client_template.addr = addr;
|
||
|
|
||
|
i2c = kmemdup(&client_template, sizeof(client_template), GFP_KERNEL);
|
||
|
if (i2c == NULL) {
|
||
|
kfree(codec);
|
||
|
return -ENOMEM;
|
||
|
}
|
||
|
i2c_set_clientdata(i2c, codec);
|
||
|
codec->control_data = i2c;
|
||
|
|
||
|
ret = i2c_attach_client(i2c);
|
||
|
if (ret < 0) {
|
||
|
dev_err(&adap->dev,
|
||
|
"failed to attach codec at addr %x\n", addr);
|
||
|
goto err;
|
||
|
}
|
||
|
|
||
|
ret = wm8900_init(socdev);
|
||
|
if (ret < 0) {
|
||
|
dev_err(&adap->dev, "failed to initialise WM8900\n");
|
||
|
goto err;
|
||
|
}
|
||
|
return ret;
|
||
|
|
||
|
err:
|
||
|
kfree(codec);
|
||
|
kfree(i2c);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int wm8900_i2c_detach(struct i2c_client *client)
|
||
|
{
|
||
|
struct snd_soc_codec *codec = i2c_get_clientdata(client);
|
||
|
i2c_detach_client(client);
|
||
|
kfree(codec->reg_cache);
|
||
|
kfree(client);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int wm8900_i2c_attach(struct i2c_adapter *adap)
|
||
|
{
|
||
|
return i2c_probe(adap, &addr_data, wm8900_codec_probe);
|
||
|
}
|
||
|
|
||
|
/* corgi i2c codec control layer */
|
||
|
static struct i2c_driver wm8900_i2c_driver = {
|
||
|
.driver = {
|
||
|
.name = "WM8900 I2C codec",
|
||
|
.owner = THIS_MODULE,
|
||
|
},
|
||
|
.attach_adapter = wm8900_i2c_attach,
|
||
|
.detach_client = wm8900_i2c_detach,
|
||
|
.command = NULL,
|
||
|
};
|
||
|
|
||
|
static struct i2c_client client_template = {
|
||
|
.name = "WM8900",
|
||
|
.driver = &wm8900_i2c_driver,
|
||
|
};
|
||
|
#endif
|
||
|
|
||
|
static int wm8900_probe(struct platform_device *pdev)
|
||
|
{
|
||
|
struct snd_soc_device *socdev = platform_get_drvdata(pdev);
|
||
|
struct wm8900_setup_data *setup;
|
||
|
struct snd_soc_codec *codec;
|
||
|
int ret = 0;
|
||
|
|
||
|
dev_info(&pdev->dev, "WM8900 Audio Codec\n");
|
||
|
|
||
|
setup = socdev->codec_data;
|
||
|
codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
|
||
|
if (codec == NULL)
|
||
|
return -ENOMEM;
|
||
|
|
||
|
mutex_init(&codec->mutex);
|
||
|
INIT_LIST_HEAD(&codec->dapm_widgets);
|
||
|
INIT_LIST_HEAD(&codec->dapm_paths);
|
||
|
|
||
|
socdev->codec = codec;
|
||
|
|
||
|
codec->set_bias_level = wm8900_set_bias_level;
|
||
|
|
||
|
wm8900_socdev = socdev;
|
||
|
#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
|
||
|
if (setup->i2c_address) {
|
||
|
normal_i2c[0] = setup->i2c_address;
|
||
|
codec->hw_write = (hw_write_t)i2c_master_send;
|
||
|
ret = i2c_add_driver(&wm8900_i2c_driver);
|
||
|
if (ret != 0)
|
||
|
printk(KERN_ERR "can't add i2c driver");
|
||
|
}
|
||
|
#else
|
||
|
#error Non-I2C interfaces not yet supported
|
||
|
#endif
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
/* power down chip */
|
||
|
static int wm8900_remove(struct platform_device *pdev)
|
||
|
{
|
||
|
struct snd_soc_device *socdev = platform_get_drvdata(pdev);
|
||
|
struct snd_soc_codec *codec = socdev->codec;
|
||
|
|
||
|
if (codec->control_data)
|
||
|
wm8900_set_bias_level(codec, SND_SOC_BIAS_OFF);
|
||
|
|
||
|
snd_soc_free_pcms(socdev);
|
||
|
snd_soc_dapm_free(socdev);
|
||
|
#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
|
||
|
i2c_del_driver(&wm8900_i2c_driver);
|
||
|
#endif
|
||
|
kfree(codec);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
struct snd_soc_codec_device soc_codec_dev_wm8900 = {
|
||
|
.probe = wm8900_probe,
|
||
|
.remove = wm8900_remove,
|
||
|
.suspend = wm8900_suspend,
|
||
|
.resume = wm8900_resume,
|
||
|
};
|
||
|
EXPORT_SYMBOL_GPL(soc_codec_dev_wm8900);
|
||
|
|
||
|
MODULE_DESCRIPTION("ASoC WM8900 driver");
|
||
|
MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfonmicro.com>");
|
||
|
MODULE_LICENSE("GPL");
|