774 lines
22 KiB
C
774 lines
22 KiB
C
|
/*
|
||
|
* ALSA SoC WM9090 driver
|
||
|
*
|
||
|
* Copyright 2009, 2010 Wolfson Microelectronics
|
||
|
*
|
||
|
* 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.
|
||
|
*
|
||
|
* This program is distributed in the hope that it will be useful, but
|
||
|
* WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
||
|
* General Public License for more details.
|
||
|
*
|
||
|
* You should have received a copy of the GNU General Public License
|
||
|
* along with this program; if not, write to the Free Software
|
||
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
|
||
|
* 02110-1301 USA
|
||
|
*/
|
||
|
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/errno.h>
|
||
|
#include <linux/device.h>
|
||
|
#include <linux/i2c.h>
|
||
|
#include <linux/delay.h>
|
||
|
#include <linux/slab.h>
|
||
|
#include <sound/initval.h>
|
||
|
#include <sound/soc.h>
|
||
|
#include <sound/soc-dapm.h>
|
||
|
#include <sound/tlv.h>
|
||
|
#include <sound/wm9090.h>
|
||
|
|
||
|
#include "wm9090.h"
|
||
|
|
||
|
static struct snd_soc_codec *wm9090_codec;
|
||
|
|
||
|
static const u16 wm9090_reg_defaults[] = {
|
||
|
0x9093, /* R0 - Software Reset */
|
||
|
0x0006, /* R1 - Power Management (1) */
|
||
|
0x6000, /* R2 - Power Management (2) */
|
||
|
0x0000, /* R3 - Power Management (3) */
|
||
|
0x0000, /* R4 */
|
||
|
0x0000, /* R5 */
|
||
|
0x01C0, /* R6 - Clocking 1 */
|
||
|
0x0000, /* R7 */
|
||
|
0x0000, /* R8 */
|
||
|
0x0000, /* R9 */
|
||
|
0x0000, /* R10 */
|
||
|
0x0000, /* R11 */
|
||
|
0x0000, /* R12 */
|
||
|
0x0000, /* R13 */
|
||
|
0x0000, /* R14 */
|
||
|
0x0000, /* R15 */
|
||
|
0x0000, /* R16 */
|
||
|
0x0000, /* R17 */
|
||
|
0x0000, /* R18 */
|
||
|
0x0000, /* R19 */
|
||
|
0x0000, /* R20 */
|
||
|
0x0000, /* R21 */
|
||
|
0x0003, /* R22 - IN1 Line Control */
|
||
|
0x0003, /* R23 - IN2 Line Control */
|
||
|
0x0083, /* R24 - IN1 Line Input A Volume */
|
||
|
0x0083, /* R25 - IN1 Line Input B Volume */
|
||
|
0x0083, /* R26 - IN2 Line Input A Volume */
|
||
|
0x0083, /* R27 - IN2 Line Input B Volume */
|
||
|
0x002D, /* R28 - Left Output Volume */
|
||
|
0x002D, /* R29 - Right Output Volume */
|
||
|
0x0000, /* R30 */
|
||
|
0x0000, /* R31 */
|
||
|
0x0000, /* R32 */
|
||
|
0x0000, /* R33 */
|
||
|
0x0100, /* R34 - SPKMIXL Attenuation */
|
||
|
0x0000, /* R35 */
|
||
|
0x0010, /* R36 - SPKOUT Mixers */
|
||
|
0x0140, /* R37 - ClassD3 */
|
||
|
0x0039, /* R38 - Speaker Volume Left */
|
||
|
0x0000, /* R39 */
|
||
|
0x0000, /* R40 */
|
||
|
0x0000, /* R41 */
|
||
|
0x0000, /* R42 */
|
||
|
0x0000, /* R43 */
|
||
|
0x0000, /* R44 */
|
||
|
0x0000, /* R45 - Output Mixer1 */
|
||
|
0x0000, /* R46 - Output Mixer2 */
|
||
|
0x0100, /* R47 - Output Mixer3 */
|
||
|
0x0100, /* R48 - Output Mixer4 */
|
||
|
0x0000, /* R49 */
|
||
|
0x0000, /* R50 */
|
||
|
0x0000, /* R51 */
|
||
|
0x0000, /* R52 */
|
||
|
0x0000, /* R53 */
|
||
|
0x0000, /* R54 - Speaker Mixer */
|
||
|
0x0000, /* R55 */
|
||
|
0x0000, /* R56 */
|
||
|
0x000D, /* R57 - AntiPOP2 */
|
||
|
0x0000, /* R58 */
|
||
|
0x0000, /* R59 */
|
||
|
0x0000, /* R60 */
|
||
|
0x0000, /* R61 */
|
||
|
0x0000, /* R62 */
|
||
|
0x0000, /* R63 */
|
||
|
0x0000, /* R64 */
|
||
|
0x0000, /* R65 */
|
||
|
0x0000, /* R66 */
|
||
|
0x0000, /* R67 */
|
||
|
0x0000, /* R68 */
|
||
|
0x0000, /* R69 */
|
||
|
0x0000, /* R70 - Write Sequencer 0 */
|
||
|
0x0000, /* R71 - Write Sequencer 1 */
|
||
|
0x0000, /* R72 - Write Sequencer 2 */
|
||
|
0x0000, /* R73 - Write Sequencer 3 */
|
||
|
0x0000, /* R74 - Write Sequencer 4 */
|
||
|
0x0000, /* R75 - Write Sequencer 5 */
|
||
|
0x1F25, /* R76 - Charge Pump 1 */
|
||
|
0x0000, /* R77 */
|
||
|
0x0000, /* R78 */
|
||
|
0x0000, /* R79 */
|
||
|
0x0000, /* R80 */
|
||
|
0x0000, /* R81 */
|
||
|
0x0000, /* R82 */
|
||
|
0x0000, /* R83 */
|
||
|
0x0000, /* R84 - DC Servo 0 */
|
||
|
0x054A, /* R85 - DC Servo 1 */
|
||
|
0x0000, /* R86 */
|
||
|
0x0000, /* R87 - DC Servo 3 */
|
||
|
0x0000, /* R88 - DC Servo Readback 0 */
|
||
|
0x0000, /* R89 - DC Servo Readback 1 */
|
||
|
0x0000, /* R90 - DC Servo Readback 2 */
|
||
|
0x0000, /* R91 */
|
||
|
0x0000, /* R92 */
|
||
|
0x0000, /* R93 */
|
||
|
0x0000, /* R94 */
|
||
|
0x0000, /* R95 */
|
||
|
0x0100, /* R96 - Analogue HP 0 */
|
||
|
0x0000, /* R97 */
|
||
|
0x8640, /* R98 - AGC Control 0 */
|
||
|
0xC000, /* R99 - AGC Control 1 */
|
||
|
0x0200, /* R100 - AGC Control 2 */
|
||
|
};
|
||
|
|
||
|
/* This struct is used to save the context */
|
||
|
struct wm9090_priv {
|
||
|
/* We're not really registering as a CODEC since ASoC core
|
||
|
* does not yet support multiple CODECs but having the CODEC
|
||
|
* structure means we can reuse some of the ASoC core
|
||
|
* features.
|
||
|
*/
|
||
|
struct snd_soc_codec codec;
|
||
|
struct mutex mutex;
|
||
|
u16 reg_cache[WM9090_MAX_REGISTER + 1];
|
||
|
struct wm9090_platform_data pdata;
|
||
|
};
|
||
|
|
||
|
static int wm9090_volatile(unsigned int reg)
|
||
|
{
|
||
|
switch (reg) {
|
||
|
case WM9090_SOFTWARE_RESET:
|
||
|
case WM9090_DC_SERVO_0:
|
||
|
case WM9090_DC_SERVO_READBACK_0:
|
||
|
case WM9090_DC_SERVO_READBACK_1:
|
||
|
case WM9090_DC_SERVO_READBACK_2:
|
||
|
return 1;
|
||
|
|
||
|
default:
|
||
|
return 0;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static void wait_for_dc_servo(struct snd_soc_codec *codec)
|
||
|
{
|
||
|
unsigned int reg;
|
||
|
int count = 0;
|
||
|
|
||
|
dev_dbg(codec->dev, "Waiting for DC servo...\n");
|
||
|
do {
|
||
|
count++;
|
||
|
msleep(1);
|
||
|
reg = snd_soc_read(codec, WM9090_DC_SERVO_READBACK_0);
|
||
|
dev_dbg(codec->dev, "DC servo status: %x\n", reg);
|
||
|
} while ((reg & WM9090_DCS_CAL_COMPLETE_MASK)
|
||
|
!= WM9090_DCS_CAL_COMPLETE_MASK && count < 1000);
|
||
|
|
||
|
if ((reg & WM9090_DCS_CAL_COMPLETE_MASK)
|
||
|
!= WM9090_DCS_CAL_COMPLETE_MASK)
|
||
|
dev_err(codec->dev, "Timed out waiting for DC Servo\n");
|
||
|
}
|
||
|
|
||
|
static const unsigned int in_tlv[] = {
|
||
|
TLV_DB_RANGE_HEAD(6),
|
||
|
0, 0, TLV_DB_SCALE_ITEM(-600, 0, 0),
|
||
|
1, 3, TLV_DB_SCALE_ITEM(-350, 350, 0),
|
||
|
4, 6, TLV_DB_SCALE_ITEM(600, 600, 0),
|
||
|
};
|
||
|
static const unsigned int mix_tlv[] = {
|
||
|
TLV_DB_RANGE_HEAD(4),
|
||
|
0, 2, TLV_DB_SCALE_ITEM(-1200, 300, 0),
|
||
|
3, 3, TLV_DB_SCALE_ITEM(0, 0, 0),
|
||
|
};
|
||
|
static const DECLARE_TLV_DB_SCALE(out_tlv, -5700, 100, 0);
|
||
|
static const unsigned int spkboost_tlv[] = {
|
||
|
TLV_DB_RANGE_HEAD(7),
|
||
|
0, 6, TLV_DB_SCALE_ITEM(0, 150, 0),
|
||
|
7, 7, TLV_DB_SCALE_ITEM(1200, 0, 0),
|
||
|
};
|
||
|
|
||
|
static const struct snd_kcontrol_new wm9090_controls[] = {
|
||
|
SOC_SINGLE_TLV("IN1A Volume", WM9090_IN1_LINE_INPUT_A_VOLUME, 0, 6, 0,
|
||
|
in_tlv),
|
||
|
SOC_SINGLE("IN1A Switch", WM9090_IN1_LINE_INPUT_A_VOLUME, 7, 1, 1),
|
||
|
SOC_SINGLE("IN1A ZC Switch", WM9090_IN1_LINE_INPUT_A_VOLUME, 6, 1, 0),
|
||
|
|
||
|
SOC_SINGLE_TLV("IN2A Volume", WM9090_IN2_LINE_INPUT_A_VOLUME, 0, 6, 0,
|
||
|
in_tlv),
|
||
|
SOC_SINGLE("IN2A Switch", WM9090_IN2_LINE_INPUT_A_VOLUME, 7, 1, 1),
|
||
|
SOC_SINGLE("IN2A ZC Switch", WM9090_IN2_LINE_INPUT_A_VOLUME, 6, 1, 0),
|
||
|
|
||
|
SOC_SINGLE("MIXOUTL Switch", WM9090_OUTPUT_MIXER3, 8, 1, 1),
|
||
|
SOC_SINGLE_TLV("MIXOUTL IN1A Volume", WM9090_OUTPUT_MIXER3, 6, 3, 1,
|
||
|
mix_tlv),
|
||
|
SOC_SINGLE_TLV("MIXOUTL IN2A Volume", WM9090_OUTPUT_MIXER3, 2, 3, 1,
|
||
|
mix_tlv),
|
||
|
|
||
|
SOC_SINGLE("MIXOUTR Switch", WM9090_OUTPUT_MIXER4, 8, 1, 1),
|
||
|
SOC_SINGLE_TLV("MIXOUTR IN1A Volume", WM9090_OUTPUT_MIXER4, 6, 3, 1,
|
||
|
mix_tlv),
|
||
|
SOC_SINGLE_TLV("MIXOUTR IN2A Volume", WM9090_OUTPUT_MIXER4, 2, 3, 1,
|
||
|
mix_tlv),
|
||
|
|
||
|
SOC_SINGLE("SPKMIX Switch", WM9090_SPKMIXL_ATTENUATION, 8, 1, 1),
|
||
|
SOC_SINGLE_TLV("SPKMIX IN1A Volume", WM9090_SPKMIXL_ATTENUATION, 6, 3, 1,
|
||
|
mix_tlv),
|
||
|
SOC_SINGLE_TLV("SPKMIX IN2A Volume", WM9090_SPKMIXL_ATTENUATION, 2, 3, 1,
|
||
|
mix_tlv),
|
||
|
|
||
|
SOC_DOUBLE_R_TLV("Headphone Volume", WM9090_LEFT_OUTPUT_VOLUME,
|
||
|
WM9090_RIGHT_OUTPUT_VOLUME, 0, 63, 0, out_tlv),
|
||
|
SOC_DOUBLE_R("Headphone Switch", WM9090_LEFT_OUTPUT_VOLUME,
|
||
|
WM9090_RIGHT_OUTPUT_VOLUME, 6, 1, 1),
|
||
|
SOC_DOUBLE_R("Headphone ZC Switch", WM9090_LEFT_OUTPUT_VOLUME,
|
||
|
WM9090_RIGHT_OUTPUT_VOLUME, 7, 1, 0),
|
||
|
|
||
|
SOC_SINGLE_TLV("Speaker Volume", WM9090_SPEAKER_VOLUME_LEFT, 0, 63, 0,
|
||
|
out_tlv),
|
||
|
SOC_SINGLE("Speaker Switch", WM9090_SPEAKER_VOLUME_LEFT, 6, 1, 1),
|
||
|
SOC_SINGLE("Speaker ZC Switch", WM9090_SPEAKER_VOLUME_LEFT, 7, 1, 0),
|
||
|
SOC_SINGLE_TLV("Speaker Boost Volume", WM9090_CLASSD3, 3, 7, 0, spkboost_tlv),
|
||
|
};
|
||
|
|
||
|
static const struct snd_kcontrol_new wm9090_in1_se_controls[] = {
|
||
|
SOC_SINGLE_TLV("IN1B Volume", WM9090_IN1_LINE_INPUT_B_VOLUME, 0, 6, 0,
|
||
|
in_tlv),
|
||
|
SOC_SINGLE("IN1B Switch", WM9090_IN1_LINE_INPUT_B_VOLUME, 7, 1, 1),
|
||
|
SOC_SINGLE("IN1B ZC Switch", WM9090_IN1_LINE_INPUT_B_VOLUME, 6, 1, 0),
|
||
|
|
||
|
SOC_SINGLE_TLV("SPKMIX IN1B Volume", WM9090_SPKMIXL_ATTENUATION, 4, 3, 1,
|
||
|
mix_tlv),
|
||
|
SOC_SINGLE_TLV("MIXOUTL IN1B Volume", WM9090_OUTPUT_MIXER3, 4, 3, 1,
|
||
|
mix_tlv),
|
||
|
SOC_SINGLE_TLV("MIXOUTR IN1B Volume", WM9090_OUTPUT_MIXER4, 4, 3, 1,
|
||
|
mix_tlv),
|
||
|
};
|
||
|
|
||
|
static const struct snd_kcontrol_new wm9090_in2_se_controls[] = {
|
||
|
SOC_SINGLE_TLV("IN2B Volume", WM9090_IN2_LINE_INPUT_B_VOLUME, 0, 6, 0,
|
||
|
in_tlv),
|
||
|
SOC_SINGLE("IN2B Switch", WM9090_IN2_LINE_INPUT_B_VOLUME, 7, 1, 1),
|
||
|
SOC_SINGLE("IN2B ZC Switch", WM9090_IN2_LINE_INPUT_B_VOLUME, 6, 1, 0),
|
||
|
|
||
|
SOC_SINGLE_TLV("SPKMIX IN2B Volume", WM9090_SPKMIXL_ATTENUATION, 0, 3, 1,
|
||
|
mix_tlv),
|
||
|
SOC_SINGLE_TLV("MIXOUTL IN2B Volume", WM9090_OUTPUT_MIXER3, 0, 3, 1,
|
||
|
mix_tlv),
|
||
|
SOC_SINGLE_TLV("MIXOUTR IN2B Volume", WM9090_OUTPUT_MIXER4, 0, 3, 1,
|
||
|
mix_tlv),
|
||
|
};
|
||
|
|
||
|
static int hp_ev(struct snd_soc_dapm_widget *w,
|
||
|
struct snd_kcontrol *kcontrol, int event)
|
||
|
{
|
||
|
struct snd_soc_codec *codec = w->codec;
|
||
|
unsigned int reg = snd_soc_read(codec, WM9090_ANALOGUE_HP_0);
|
||
|
|
||
|
switch (event) {
|
||
|
case SND_SOC_DAPM_POST_PMU:
|
||
|
snd_soc_update_bits(codec, WM9090_CHARGE_PUMP_1,
|
||
|
WM9090_CP_ENA, WM9090_CP_ENA);
|
||
|
|
||
|
msleep(5);
|
||
|
|
||
|
snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
|
||
|
WM9090_HPOUT1L_ENA | WM9090_HPOUT1R_ENA,
|
||
|
WM9090_HPOUT1L_ENA | WM9090_HPOUT1R_ENA);
|
||
|
|
||
|
reg |= WM9090_HPOUT1L_DLY | WM9090_HPOUT1R_DLY;
|
||
|
snd_soc_write(codec, WM9090_ANALOGUE_HP_0, reg);
|
||
|
|
||
|
/* Start the DC servo. We don't currently use the
|
||
|
* ability to save the state since we don't have full
|
||
|
* control of the analogue paths and they can change
|
||
|
* DC offsets; see the WM8904 driver for an example of
|
||
|
* doing so.
|
||
|
*/
|
||
|
snd_soc_write(codec, WM9090_DC_SERVO_0,
|
||
|
WM9090_DCS_ENA_CHAN_0 |
|
||
|
WM9090_DCS_ENA_CHAN_1 |
|
||
|
WM9090_DCS_TRIG_STARTUP_1 |
|
||
|
WM9090_DCS_TRIG_STARTUP_0);
|
||
|
wait_for_dc_servo(codec);
|
||
|
|
||
|
reg |= WM9090_HPOUT1R_OUTP | WM9090_HPOUT1R_RMV_SHORT |
|
||
|
WM9090_HPOUT1L_OUTP | WM9090_HPOUT1L_RMV_SHORT;
|
||
|
snd_soc_write(codec, WM9090_ANALOGUE_HP_0, reg);
|
||
|
break;
|
||
|
|
||
|
case SND_SOC_DAPM_PRE_PMD:
|
||
|
reg &= ~(WM9090_HPOUT1L_RMV_SHORT |
|
||
|
WM9090_HPOUT1L_DLY |
|
||
|
WM9090_HPOUT1L_OUTP |
|
||
|
WM9090_HPOUT1R_RMV_SHORT |
|
||
|
WM9090_HPOUT1R_DLY |
|
||
|
WM9090_HPOUT1R_OUTP);
|
||
|
|
||
|
snd_soc_write(codec, WM9090_ANALOGUE_HP_0, reg);
|
||
|
|
||
|
snd_soc_write(codec, WM9090_DC_SERVO_0, 0);
|
||
|
|
||
|
snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
|
||
|
WM9090_HPOUT1L_ENA | WM9090_HPOUT1R_ENA,
|
||
|
0);
|
||
|
|
||
|
snd_soc_update_bits(codec, WM9090_CHARGE_PUMP_1,
|
||
|
WM9090_CP_ENA, 0);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static const struct snd_kcontrol_new spkmix[] = {
|
||
|
SOC_DAPM_SINGLE("IN1A Switch", WM9090_SPEAKER_MIXER, 6, 1, 0),
|
||
|
SOC_DAPM_SINGLE("IN1B Switch", WM9090_SPEAKER_MIXER, 4, 1, 0),
|
||
|
SOC_DAPM_SINGLE("IN2A Switch", WM9090_SPEAKER_MIXER, 2, 1, 0),
|
||
|
SOC_DAPM_SINGLE("IN2B Switch", WM9090_SPEAKER_MIXER, 0, 1, 0),
|
||
|
};
|
||
|
|
||
|
static const struct snd_kcontrol_new spkout[] = {
|
||
|
SOC_DAPM_SINGLE("Mixer Switch", WM9090_SPKOUT_MIXERS, 4, 1, 0),
|
||
|
};
|
||
|
|
||
|
static const struct snd_kcontrol_new mixoutl[] = {
|
||
|
SOC_DAPM_SINGLE("IN1A Switch", WM9090_OUTPUT_MIXER1, 6, 1, 0),
|
||
|
SOC_DAPM_SINGLE("IN1B Switch", WM9090_OUTPUT_MIXER1, 4, 1, 0),
|
||
|
SOC_DAPM_SINGLE("IN2A Switch", WM9090_OUTPUT_MIXER1, 2, 1, 0),
|
||
|
SOC_DAPM_SINGLE("IN2B Switch", WM9090_OUTPUT_MIXER1, 0, 1, 0),
|
||
|
};
|
||
|
|
||
|
static const struct snd_kcontrol_new mixoutr[] = {
|
||
|
SOC_DAPM_SINGLE("IN1A Switch", WM9090_OUTPUT_MIXER2, 6, 1, 0),
|
||
|
SOC_DAPM_SINGLE("IN1B Switch", WM9090_OUTPUT_MIXER2, 4, 1, 0),
|
||
|
SOC_DAPM_SINGLE("IN2A Switch", WM9090_OUTPUT_MIXER2, 2, 1, 0),
|
||
|
SOC_DAPM_SINGLE("IN2B Switch", WM9090_OUTPUT_MIXER2, 0, 1, 0),
|
||
|
};
|
||
|
|
||
|
static const struct snd_soc_dapm_widget wm9090_dapm_widgets[] = {
|
||
|
SND_SOC_DAPM_INPUT("IN1+"),
|
||
|
SND_SOC_DAPM_INPUT("IN1-"),
|
||
|
SND_SOC_DAPM_INPUT("IN2+"),
|
||
|
SND_SOC_DAPM_INPUT("IN2-"),
|
||
|
|
||
|
SND_SOC_DAPM_SUPPLY("OSC", WM9090_POWER_MANAGEMENT_1, 3, 0, NULL, 0),
|
||
|
|
||
|
SND_SOC_DAPM_PGA("IN1A PGA", WM9090_POWER_MANAGEMENT_2, 7, 0, NULL, 0),
|
||
|
SND_SOC_DAPM_PGA("IN1B PGA", WM9090_POWER_MANAGEMENT_2, 6, 0, NULL, 0),
|
||
|
SND_SOC_DAPM_PGA("IN2A PGA", WM9090_POWER_MANAGEMENT_2, 5, 0, NULL, 0),
|
||
|
SND_SOC_DAPM_PGA("IN2B PGA", WM9090_POWER_MANAGEMENT_2, 4, 0, NULL, 0),
|
||
|
|
||
|
SND_SOC_DAPM_MIXER("SPKMIX", WM9090_POWER_MANAGEMENT_3, 3, 0,
|
||
|
spkmix, ARRAY_SIZE(spkmix)),
|
||
|
SND_SOC_DAPM_MIXER("MIXOUTL", WM9090_POWER_MANAGEMENT_3, 5, 0,
|
||
|
mixoutl, ARRAY_SIZE(mixoutl)),
|
||
|
SND_SOC_DAPM_MIXER("MIXOUTR", WM9090_POWER_MANAGEMENT_3, 4, 0,
|
||
|
mixoutr, ARRAY_SIZE(mixoutr)),
|
||
|
|
||
|
SND_SOC_DAPM_PGA_E("HP PGA", SND_SOC_NOPM, 0, 0, NULL, 0,
|
||
|
hp_ev, SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
|
||
|
|
||
|
SND_SOC_DAPM_PGA("SPKPGA", WM9090_POWER_MANAGEMENT_3, 8, 0, NULL, 0),
|
||
|
SND_SOC_DAPM_MIXER("SPKOUT", WM9090_POWER_MANAGEMENT_1, 12, 0,
|
||
|
spkout, ARRAY_SIZE(spkout)),
|
||
|
|
||
|
SND_SOC_DAPM_OUTPUT("HPR"),
|
||
|
SND_SOC_DAPM_OUTPUT("HPL"),
|
||
|
SND_SOC_DAPM_OUTPUT("Speaker"),
|
||
|
};
|
||
|
|
||
|
static const struct snd_soc_dapm_route audio_map[] = {
|
||
|
{ "IN1A PGA", NULL, "IN1+" },
|
||
|
{ "IN2A PGA", NULL, "IN2+" },
|
||
|
|
||
|
{ "SPKMIX", "IN1A Switch", "IN1A PGA" },
|
||
|
{ "SPKMIX", "IN2A Switch", "IN2A PGA" },
|
||
|
|
||
|
{ "MIXOUTL", "IN1A Switch", "IN1A PGA" },
|
||
|
{ "MIXOUTL", "IN2A Switch", "IN2A PGA" },
|
||
|
|
||
|
{ "MIXOUTR", "IN1A Switch", "IN1A PGA" },
|
||
|
{ "MIXOUTR", "IN2A Switch", "IN2A PGA" },
|
||
|
|
||
|
{ "HP PGA", NULL, "OSC" },
|
||
|
{ "HP PGA", NULL, "MIXOUTL" },
|
||
|
{ "HP PGA", NULL, "MIXOUTR" },
|
||
|
|
||
|
{ "HPL", NULL, "HP PGA" },
|
||
|
{ "HPR", NULL, "HP PGA" },
|
||
|
|
||
|
{ "SPKPGA", NULL, "OSC" },
|
||
|
{ "SPKPGA", NULL, "SPKMIX" },
|
||
|
|
||
|
{ "SPKOUT", "Mixer Switch", "SPKPGA" },
|
||
|
|
||
|
{ "Speaker", NULL, "SPKOUT" },
|
||
|
};
|
||
|
|
||
|
static const struct snd_soc_dapm_route audio_map_in1_se[] = {
|
||
|
{ "IN1B PGA", NULL, "IN1-" },
|
||
|
|
||
|
{ "SPKMIX", "IN1B Switch", "IN1B PGA" },
|
||
|
{ "MIXOUTL", "IN1B Switch", "IN1B PGA" },
|
||
|
{ "MIXOUTR", "IN1B Switch", "IN1B PGA" },
|
||
|
};
|
||
|
|
||
|
static const struct snd_soc_dapm_route audio_map_in1_diff[] = {
|
||
|
{ "IN1A PGA", NULL, "IN1-" },
|
||
|
};
|
||
|
|
||
|
static const struct snd_soc_dapm_route audio_map_in2_se[] = {
|
||
|
{ "IN2B PGA", NULL, "IN2-" },
|
||
|
|
||
|
{ "SPKMIX", "IN2B Switch", "IN2B PGA" },
|
||
|
{ "MIXOUTL", "IN2B Switch", "IN2B PGA" },
|
||
|
{ "MIXOUTR", "IN2B Switch", "IN2B PGA" },
|
||
|
};
|
||
|
|
||
|
static const struct snd_soc_dapm_route audio_map_in2_diff[] = {
|
||
|
{ "IN2A PGA", NULL, "IN2-" },
|
||
|
};
|
||
|
|
||
|
static int wm9090_add_controls(struct snd_soc_codec *codec)
|
||
|
{
|
||
|
struct wm9090_priv *wm9090 = snd_soc_codec_get_drvdata(codec);
|
||
|
int i;
|
||
|
|
||
|
snd_soc_dapm_new_controls(codec, wm9090_dapm_widgets,
|
||
|
ARRAY_SIZE(wm9090_dapm_widgets));
|
||
|
|
||
|
snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
|
||
|
|
||
|
snd_soc_add_controls(codec, wm9090_controls,
|
||
|
ARRAY_SIZE(wm9090_controls));
|
||
|
|
||
|
if (wm9090->pdata.lin1_diff) {
|
||
|
snd_soc_dapm_add_routes(codec, audio_map_in1_diff,
|
||
|
ARRAY_SIZE(audio_map_in1_diff));
|
||
|
} else {
|
||
|
snd_soc_dapm_add_routes(codec, audio_map_in1_se,
|
||
|
ARRAY_SIZE(audio_map_in1_se));
|
||
|
snd_soc_add_controls(codec, wm9090_in1_se_controls,
|
||
|
ARRAY_SIZE(wm9090_in1_se_controls));
|
||
|
}
|
||
|
|
||
|
if (wm9090->pdata.lin2_diff) {
|
||
|
snd_soc_dapm_add_routes(codec, audio_map_in2_diff,
|
||
|
ARRAY_SIZE(audio_map_in2_diff));
|
||
|
} else {
|
||
|
snd_soc_dapm_add_routes(codec, audio_map_in2_se,
|
||
|
ARRAY_SIZE(audio_map_in2_se));
|
||
|
snd_soc_add_controls(codec, wm9090_in2_se_controls,
|
||
|
ARRAY_SIZE(wm9090_in2_se_controls));
|
||
|
}
|
||
|
|
||
|
if (wm9090->pdata.agc_ena) {
|
||
|
for (i = 0; i < ARRAY_SIZE(wm9090->pdata.agc); i++)
|
||
|
snd_soc_write(codec, WM9090_AGC_CONTROL_0 + i,
|
||
|
wm9090->pdata.agc[i]);
|
||
|
snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_3,
|
||
|
WM9090_AGC_ENA, WM9090_AGC_ENA);
|
||
|
} else {
|
||
|
snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_3,
|
||
|
WM9090_AGC_ENA, 0);
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* The machine driver should call this from their set_bias_level; if there
|
||
|
* isn't one then this can just be set as the set_bias_level function.
|
||
|
*/
|
||
|
static int wm9090_set_bias_level(struct snd_soc_codec *codec,
|
||
|
enum snd_soc_bias_level level)
|
||
|
{
|
||
|
u16 *reg_cache = codec->reg_cache;
|
||
|
int i, ret;
|
||
|
|
||
|
switch (level) {
|
||
|
case SND_SOC_BIAS_ON:
|
||
|
break;
|
||
|
|
||
|
case SND_SOC_BIAS_PREPARE:
|
||
|
snd_soc_update_bits(codec, WM9090_ANTIPOP2, WM9090_VMID_ENA,
|
||
|
WM9090_VMID_ENA);
|
||
|
snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
|
||
|
WM9090_BIAS_ENA |
|
||
|
WM9090_VMID_RES_MASK,
|
||
|
WM9090_BIAS_ENA |
|
||
|
1 << WM9090_VMID_RES_SHIFT);
|
||
|
msleep(1); /* Probably an overestimate */
|
||
|
break;
|
||
|
|
||
|
case SND_SOC_BIAS_STANDBY:
|
||
|
if (codec->bias_level == SND_SOC_BIAS_OFF) {
|
||
|
/* Restore the register cache */
|
||
|
for (i = 1; i < codec->reg_cache_size; i++) {
|
||
|
if (reg_cache[i] == wm9090_reg_defaults[i])
|
||
|
continue;
|
||
|
if (wm9090_volatile(i))
|
||
|
continue;
|
||
|
|
||
|
ret = snd_soc_write(codec, i, reg_cache[i]);
|
||
|
if (ret != 0)
|
||
|
dev_warn(codec->dev,
|
||
|
"Failed to restore register %d: %d\n",
|
||
|
i, ret);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* We keep VMID off during standby since the combination of
|
||
|
* ground referenced outputs and class D speaker mean that
|
||
|
* latency is not an issue.
|
||
|
*/
|
||
|
snd_soc_update_bits(codec, WM9090_POWER_MANAGEMENT_1,
|
||
|
WM9090_BIAS_ENA | WM9090_VMID_RES_MASK, 0);
|
||
|
snd_soc_update_bits(codec, WM9090_ANTIPOP2,
|
||
|
WM9090_VMID_ENA, 0);
|
||
|
break;
|
||
|
|
||
|
case SND_SOC_BIAS_OFF:
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
codec->bias_level = level;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int wm9090_probe(struct platform_device *pdev)
|
||
|
{
|
||
|
struct snd_soc_device *socdev = platform_get_drvdata(pdev);
|
||
|
struct snd_soc_codec *codec;
|
||
|
int ret = 0;
|
||
|
|
||
|
if (wm9090_codec == NULL) {
|
||
|
dev_err(&pdev->dev, "Codec device not registered\n");
|
||
|
return -ENODEV;
|
||
|
}
|
||
|
|
||
|
socdev->card->codec = wm9090_codec;
|
||
|
codec = wm9090_codec;
|
||
|
|
||
|
/* register pcms */
|
||
|
ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
|
||
|
if (ret < 0) {
|
||
|
dev_err(codec->dev, "failed to create pcms: %d\n", ret);
|
||
|
goto pcm_err;
|
||
|
}
|
||
|
|
||
|
wm9090_add_controls(codec);
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
pcm_err:
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
#ifdef CONFIG_PM
|
||
|
static int wm9090_suspend(struct platform_device *pdev, pm_message_t state)
|
||
|
{
|
||
|
struct snd_soc_device *socdev = platform_get_drvdata(pdev);
|
||
|
struct snd_soc_codec *codec = socdev->card->codec;
|
||
|
|
||
|
wm9090_set_bias_level(codec, SND_SOC_BIAS_OFF);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int wm9090_resume(struct platform_device *pdev)
|
||
|
{
|
||
|
struct snd_soc_device *socdev = platform_get_drvdata(pdev);
|
||
|
struct snd_soc_codec *codec = socdev->card->codec;
|
||
|
|
||
|
wm9090_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
#else
|
||
|
#define wm9090_suspend NULL
|
||
|
#define wm9090_resume NULL
|
||
|
#endif
|
||
|
|
||
|
static int wm9090_remove(struct platform_device *pdev)
|
||
|
{
|
||
|
struct snd_soc_device *socdev = platform_get_drvdata(pdev);
|
||
|
|
||
|
snd_soc_free_pcms(socdev);
|
||
|
snd_soc_dapm_free(socdev);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
struct snd_soc_codec_device soc_codec_dev_wm9090 = {
|
||
|
.probe = wm9090_probe,
|
||
|
.remove = wm9090_remove,
|
||
|
.suspend = wm9090_suspend,
|
||
|
.resume = wm9090_resume,
|
||
|
};
|
||
|
EXPORT_SYMBOL_GPL(soc_codec_dev_wm9090);
|
||
|
|
||
|
static int wm9090_i2c_probe(struct i2c_client *i2c,
|
||
|
const struct i2c_device_id *id)
|
||
|
{
|
||
|
struct wm9090_priv *wm9090;
|
||
|
struct snd_soc_codec *codec;
|
||
|
int ret;
|
||
|
|
||
|
wm9090 = kzalloc(sizeof(*wm9090), GFP_KERNEL);
|
||
|
if (wm9090 == NULL) {
|
||
|
dev_err(&i2c->dev, "Can not allocate memory\n");
|
||
|
return -ENOMEM;
|
||
|
}
|
||
|
codec = &wm9090->codec;
|
||
|
|
||
|
if (i2c->dev.platform_data)
|
||
|
memcpy(&wm9090->pdata, i2c->dev.platform_data,
|
||
|
sizeof(wm9090->pdata));
|
||
|
|
||
|
wm9090_codec = codec;
|
||
|
|
||
|
i2c_set_clientdata(i2c, wm9090);
|
||
|
|
||
|
mutex_init(&codec->mutex);
|
||
|
INIT_LIST_HEAD(&codec->dapm_widgets);
|
||
|
INIT_LIST_HEAD(&codec->dapm_paths);
|
||
|
|
||
|
codec->control_data = i2c;
|
||
|
snd_soc_codec_set_drvdata(codec, wm9090);
|
||
|
codec->dev = &i2c->dev;
|
||
|
codec->name = "WM9090";
|
||
|
codec->owner = THIS_MODULE;
|
||
|
codec->bias_level = SND_SOC_BIAS_OFF;
|
||
|
codec->set_bias_level = wm9090_set_bias_level,
|
||
|
codec->reg_cache_size = WM9090_MAX_REGISTER + 1;
|
||
|
codec->reg_cache = &wm9090->reg_cache;
|
||
|
codec->volatile_register = wm9090_volatile;
|
||
|
|
||
|
ret = snd_soc_codec_set_cache_io(codec, 8, 16, SND_SOC_I2C);
|
||
|
if (ret != 0) {
|
||
|
dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
|
||
|
goto err;
|
||
|
}
|
||
|
|
||
|
memcpy(&wm9090->reg_cache, wm9090_reg_defaults,
|
||
|
sizeof(wm9090->reg_cache));
|
||
|
|
||
|
ret = snd_soc_read(codec, WM9090_SOFTWARE_RESET);
|
||
|
if (ret < 0)
|
||
|
goto err;
|
||
|
if (ret != wm9090_reg_defaults[WM9090_SOFTWARE_RESET]) {
|
||
|
dev_err(&i2c->dev, "Device is not a WM9090, ID=%x\n", ret);
|
||
|
ret = -EINVAL;
|
||
|
goto err;
|
||
|
}
|
||
|
|
||
|
ret = snd_soc_write(codec, WM9090_SOFTWARE_RESET, 0);
|
||
|
if (ret < 0)
|
||
|
goto err;
|
||
|
|
||
|
/* Configure some defaults; they will be written out when we
|
||
|
* bring the bias up.
|
||
|
*/
|
||
|
wm9090->reg_cache[WM9090_IN1_LINE_INPUT_A_VOLUME] |= WM9090_IN1_VU
|
||
|
| WM9090_IN1A_ZC;
|
||
|
wm9090->reg_cache[WM9090_IN1_LINE_INPUT_B_VOLUME] |= WM9090_IN1_VU
|
||
|
| WM9090_IN1B_ZC;
|
||
|
wm9090->reg_cache[WM9090_IN2_LINE_INPUT_A_VOLUME] |= WM9090_IN2_VU
|
||
|
| WM9090_IN2A_ZC;
|
||
|
wm9090->reg_cache[WM9090_IN2_LINE_INPUT_B_VOLUME] |= WM9090_IN2_VU
|
||
|
| WM9090_IN2B_ZC;
|
||
|
wm9090->reg_cache[WM9090_SPEAKER_VOLUME_LEFT] |=
|
||
|
WM9090_SPKOUT_VU | WM9090_SPKOUTL_ZC;
|
||
|
wm9090->reg_cache[WM9090_LEFT_OUTPUT_VOLUME] |=
|
||
|
WM9090_HPOUT1_VU | WM9090_HPOUT1L_ZC;
|
||
|
wm9090->reg_cache[WM9090_RIGHT_OUTPUT_VOLUME] |=
|
||
|
WM9090_HPOUT1_VU | WM9090_HPOUT1R_ZC;
|
||
|
|
||
|
wm9090->reg_cache[WM9090_CLOCKING_1] |= WM9090_TOCLK_ENA;
|
||
|
|
||
|
wm9090_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
|
||
|
|
||
|
ret = snd_soc_register_codec(codec);
|
||
|
if (ret != 0) {
|
||
|
dev_err(&i2c->dev, "Failed to register CODEC: %d\n", ret);
|
||
|
goto err_bias;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
|
||
|
err_bias:
|
||
|
wm9090_set_bias_level(codec, SND_SOC_BIAS_OFF);
|
||
|
err:
|
||
|
kfree(wm9090);
|
||
|
i2c_set_clientdata(i2c, NULL);
|
||
|
wm9090_codec = NULL;
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int wm9090_i2c_remove(struct i2c_client *i2c)
|
||
|
{
|
||
|
struct wm9090_priv *wm9090 = i2c_get_clientdata(i2c);
|
||
|
struct snd_soc_codec *codec = &wm9090->codec;
|
||
|
|
||
|
snd_soc_unregister_codec(codec);
|
||
|
wm9090_set_bias_level(codec, SND_SOC_BIAS_OFF);
|
||
|
kfree(wm9090);
|
||
|
wm9090_codec = NULL;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static const struct i2c_device_id wm9090_id[] = {
|
||
|
{ "wm9090", 0 },
|
||
|
{ }
|
||
|
};
|
||
|
MODULE_DEVICE_TABLE(i2c, wm9090_id);
|
||
|
|
||
|
static struct i2c_driver wm9090_i2c_driver = {
|
||
|
.driver = {
|
||
|
.name = "wm9090",
|
||
|
.owner = THIS_MODULE,
|
||
|
},
|
||
|
.probe = wm9090_i2c_probe,
|
||
|
.remove = __devexit_p(wm9090_i2c_remove),
|
||
|
.id_table = wm9090_id,
|
||
|
};
|
||
|
|
||
|
static int __init wm9090_init(void)
|
||
|
{
|
||
|
return i2c_add_driver(&wm9090_i2c_driver);
|
||
|
}
|
||
|
module_init(wm9090_init);
|
||
|
|
||
|
static void __exit wm9090_exit(void)
|
||
|
{
|
||
|
i2c_del_driver(&wm9090_i2c_driver);
|
||
|
}
|
||
|
module_exit(wm9090_exit);
|
||
|
|
||
|
MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
|
||
|
MODULE_DESCRIPTION("WM9090 ASoC driver");
|
||
|
MODULE_LICENSE("GPL");
|