/* * ALSA SoC WM9090 driver * * Copyright 2009, 2010 Wolfson Microelectronics * * Author: Mark Brown * * 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 #include #include #include #include #include #include #include #include #include #include "wm9090.h" 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 { struct wm9090_platform_data pdata; }; static int wm9090_volatile(struct snd_soc_codec *codec, 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(3), 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(2), 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(2), 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); struct snd_soc_dapm_context *dapm = &codec->dapm; int i; snd_soc_dapm_new_controls(dapm, wm9090_dapm_widgets, ARRAY_SIZE(wm9090_dapm_widgets)); snd_soc_dapm_add_routes(dapm, 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(dapm, audio_map_in1_diff, ARRAY_SIZE(audio_map_in1_diff)); } else { snd_soc_dapm_add_routes(dapm, 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(dapm, audio_map_in2_diff, ARRAY_SIZE(audio_map_in2_diff)); } else { snd_soc_dapm_add_routes(dapm, 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->dapm.bias_level == SND_SOC_BIAS_OFF) { /* Restore the register cache */ for (i = 1; i < codec->driver->reg_cache_size; i++) { if (reg_cache[i] == wm9090_reg_defaults[i]) continue; if (wm9090_volatile(codec, 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->dapm.bias_level = level; return 0; } static int wm9090_probe(struct snd_soc_codec *codec) { int ret; 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); return ret; } ret = snd_soc_read(codec, WM9090_SOFTWARE_RESET); if (ret < 0) return ret; if (ret != wm9090_reg_defaults[WM9090_SOFTWARE_RESET]) { dev_err(codec->dev, "Device is not a WM9090, ID=%x\n", ret); return -EINVAL; } ret = snd_soc_write(codec, WM9090_SOFTWARE_RESET, 0); if (ret < 0) return ret; /* Configure some defaults; they will be written out when we * bring the bias up. */ snd_soc_update_bits(codec, WM9090_IN1_LINE_INPUT_A_VOLUME, WM9090_IN1_VU | WM9090_IN1A_ZC, WM9090_IN1_VU | WM9090_IN1A_ZC); snd_soc_update_bits(codec, WM9090_IN1_LINE_INPUT_B_VOLUME, WM9090_IN1_VU | WM9090_IN1B_ZC, WM9090_IN1_VU | WM9090_IN1B_ZC); snd_soc_update_bits(codec, WM9090_IN2_LINE_INPUT_A_VOLUME, WM9090_IN2_VU | WM9090_IN2A_ZC, WM9090_IN2_VU | WM9090_IN2A_ZC); snd_soc_update_bits(codec, WM9090_IN2_LINE_INPUT_B_VOLUME, WM9090_IN2_VU | WM9090_IN2B_ZC, WM9090_IN2_VU | WM9090_IN2B_ZC); snd_soc_update_bits(codec, WM9090_SPEAKER_VOLUME_LEFT, WM9090_SPKOUT_VU | WM9090_SPKOUTL_ZC, WM9090_SPKOUT_VU | WM9090_SPKOUTL_ZC); snd_soc_update_bits(codec, WM9090_LEFT_OUTPUT_VOLUME, WM9090_HPOUT1_VU | WM9090_HPOUT1L_ZC, WM9090_HPOUT1_VU | WM9090_HPOUT1L_ZC); snd_soc_update_bits(codec, WM9090_RIGHT_OUTPUT_VOLUME, WM9090_HPOUT1_VU | WM9090_HPOUT1R_ZC, WM9090_HPOUT1_VU | WM9090_HPOUT1R_ZC); snd_soc_update_bits(codec, WM9090_CLOCKING_1, WM9090_TOCLK_ENA, WM9090_TOCLK_ENA); wm9090_set_bias_level(codec, SND_SOC_BIAS_STANDBY); wm9090_add_controls(codec); return 0; } #ifdef CONFIG_PM static int wm9090_suspend(struct snd_soc_codec *codec) { wm9090_set_bias_level(codec, SND_SOC_BIAS_OFF); return 0; } static int wm9090_resume(struct snd_soc_codec *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 snd_soc_codec *codec) { wm9090_set_bias_level(codec, SND_SOC_BIAS_OFF); return 0; } static struct snd_soc_codec_driver soc_codec_dev_wm9090 = { .probe = wm9090_probe, .remove = wm9090_remove, .suspend = wm9090_suspend, .resume = wm9090_resume, .set_bias_level = wm9090_set_bias_level, .reg_cache_size = (WM9090_MAX_REGISTER + 1), .reg_word_size = sizeof(u16), .reg_cache_default = wm9090_reg_defaults, .volatile_register = wm9090_volatile, }; static int wm9090_i2c_probe(struct i2c_client *i2c, const struct i2c_device_id *id) { struct wm9090_priv *wm9090; int ret; wm9090 = kzalloc(sizeof(*wm9090), GFP_KERNEL); if (wm9090 == NULL) { dev_err(&i2c->dev, "Can not allocate memory\n"); return -ENOMEM; } if (i2c->dev.platform_data) memcpy(&wm9090->pdata, i2c->dev.platform_data, sizeof(wm9090->pdata)); i2c_set_clientdata(i2c, wm9090); ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_wm9090, NULL, 0); if (ret < 0) kfree(wm9090); return ret; } static int __devexit wm9090_i2c_remove(struct i2c_client *i2c) { struct wm9090_priv *wm9090 = i2c_get_clientdata(i2c); snd_soc_unregister_codec(&i2c->dev); kfree(wm9090); return 0; } static const struct i2c_device_id wm9090_id[] = { { "wm9090", 0 }, { "wm9093", 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 "); MODULE_DESCRIPTION("WM9090 ASoC driver"); MODULE_LICENSE("GPL");