13a66d387SMark Brown /* 23a66d387SMark Brown * wm2000.c -- WM2000 ALSA Soc Audio driver 33a66d387SMark Brown * 4656baaebSMark Brown * Copyright 2008-2011 Wolfson Microelectronics PLC. 53a66d387SMark Brown * 63a66d387SMark Brown * Author: Mark Brown <broonie@opensource.wolfsonmicro.com> 73a66d387SMark Brown * 83a66d387SMark Brown * This program is free software; you can redistribute it and/or modify 93a66d387SMark Brown * it under the terms of the GNU General Public License version 2 as 103a66d387SMark Brown * published by the Free Software Foundation. 113a66d387SMark Brown * 123a66d387SMark Brown * The download image for the WM2000 will be requested as 133a66d387SMark Brown * 'wm2000_anc.bin' by default (overridable via platform data) at 143a66d387SMark Brown * runtime and is expected to be in flat binary format. This is 153a66d387SMark Brown * generated by Wolfson configuration tools and includes 16cdbd9b0cSMarkus Elfring * system-specific calibration information. If supplied as a 173a66d387SMark Brown * sequence of ASCII-encoded hexidecimal bytes this can be converted 183a66d387SMark Brown * into a flat binary with a command such as this on the command line: 193a66d387SMark Brown * 203a66d387SMark Brown * perl -e 'while (<>) { s/[\r\n]+// ; printf("%c", hex($_)); }' 213a66d387SMark Brown * < file > wm2000_anc.bin 223a66d387SMark Brown */ 233a66d387SMark Brown 243a66d387SMark Brown #include <linux/module.h> 253a66d387SMark Brown #include <linux/moduleparam.h> 263a66d387SMark Brown #include <linux/kernel.h> 273a66d387SMark Brown #include <linux/init.h> 283a66d387SMark Brown #include <linux/firmware.h> 29514cfd6dSMark Brown #include <linux/clk.h> 303a66d387SMark Brown #include <linux/delay.h> 313a66d387SMark Brown #include <linux/pm.h> 323a66d387SMark Brown #include <linux/i2c.h> 338aa1fe81SMark Brown #include <linux/regmap.h> 343a66d387SMark Brown #include <linux/debugfs.h> 35a89be93cSMark Brown #include <linux/regulator/consumer.h> 365a0e3ad6STejun Heo #include <linux/slab.h> 373a66d387SMark Brown #include <sound/core.h> 383a66d387SMark Brown #include <sound/pcm.h> 393a66d387SMark Brown #include <sound/pcm_params.h> 403a66d387SMark Brown #include <sound/soc.h> 413a66d387SMark Brown #include <sound/initval.h> 423a66d387SMark Brown #include <sound/tlv.h> 433a66d387SMark Brown 443a66d387SMark Brown #include <sound/wm2000.h> 453a66d387SMark Brown 463a66d387SMark Brown #include "wm2000.h" 473a66d387SMark Brown 48a89be93cSMark Brown #define WM2000_NUM_SUPPLIES 3 49a89be93cSMark Brown 50a89be93cSMark Brown static const char *wm2000_supplies[WM2000_NUM_SUPPLIES] = { 51a89be93cSMark Brown "SPKVDD", 52a89be93cSMark Brown "DBVDD", 53a89be93cSMark Brown "DCVDD", 54a89be93cSMark Brown }; 55a89be93cSMark Brown 563a66d387SMark Brown enum wm2000_anc_mode { 573a66d387SMark Brown ANC_ACTIVE = 0, 583a66d387SMark Brown ANC_BYPASS = 1, 593a66d387SMark Brown ANC_STANDBY = 2, 603a66d387SMark Brown ANC_OFF = 3, 613a66d387SMark Brown }; 623a66d387SMark Brown 633a66d387SMark Brown struct wm2000_priv { 643a66d387SMark Brown struct i2c_client *i2c; 658aa1fe81SMark Brown struct regmap *regmap; 66514cfd6dSMark Brown struct clk *mclk; 673a66d387SMark Brown 68a89be93cSMark Brown struct regulator_bulk_data supplies[WM2000_NUM_SUPPLIES]; 69a89be93cSMark Brown 703a66d387SMark Brown enum wm2000_anc_mode anc_mode; 713a66d387SMark Brown 723a66d387SMark Brown unsigned int anc_active:1; 733a66d387SMark Brown unsigned int anc_eng_ena:1; 743a66d387SMark Brown unsigned int spk_ena:1; 753a66d387SMark Brown 763a66d387SMark Brown unsigned int speech_clarity:1; 773a66d387SMark Brown 783a66d387SMark Brown int anc_download_size; 793a66d387SMark Brown char *anc_download; 808e9bb423SMark Brown 818e9bb423SMark Brown struct mutex lock; 823a66d387SMark Brown }; 833a66d387SMark Brown 843a66d387SMark Brown static int wm2000_write(struct i2c_client *i2c, unsigned int reg, 853a66d387SMark Brown unsigned int value) 863a66d387SMark Brown { 878aa1fe81SMark Brown struct wm2000_priv *wm2000 = i2c_get_clientdata(i2c); 888aa1fe81SMark Brown return regmap_write(wm2000->regmap, reg, value); 893a66d387SMark Brown } 903a66d387SMark Brown 913a66d387SMark Brown static void wm2000_reset(struct wm2000_priv *wm2000) 923a66d387SMark Brown { 933a66d387SMark Brown struct i2c_client *i2c = wm2000->i2c; 943a66d387SMark Brown 953a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_ENG_CLR); 963a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_CLR); 973a66d387SMark Brown wm2000_write(i2c, WM2000_REG_ID1, 0); 983a66d387SMark Brown 993a66d387SMark Brown wm2000->anc_mode = ANC_OFF; 1003a66d387SMark Brown } 1013a66d387SMark Brown 1023a66d387SMark Brown static int wm2000_poll_bit(struct i2c_client *i2c, 1033ff1ec27SMark Brown unsigned int reg, u8 mask) 1043a66d387SMark Brown { 105c5d09485SLucas Tanure struct wm2000_priv *wm2000 = i2c_get_clientdata(i2c); 1063ff1ec27SMark Brown int timeout = 4000; 107c5d09485SLucas Tanure unsigned int val; 1083a66d387SMark Brown 109c5d09485SLucas Tanure regmap_read(wm2000->regmap, reg, &val); 1103a66d387SMark Brown 1113a66d387SMark Brown while (!(val & mask) && --timeout) { 1123a66d387SMark Brown msleep(1); 113c5d09485SLucas Tanure regmap_read(wm2000->regmap, reg, &val); 1143a66d387SMark Brown } 1153a66d387SMark Brown 1163a66d387SMark Brown if (timeout == 0) 1173a66d387SMark Brown return 0; 1183a66d387SMark Brown else 1193a66d387SMark Brown return 1; 1203a66d387SMark Brown } 1213a66d387SMark Brown 1223a66d387SMark Brown static int wm2000_power_up(struct i2c_client *i2c, int analogue) 1233a66d387SMark Brown { 1243a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 125d61100bbSMark Brown unsigned long rate; 126c5d09485SLucas Tanure unsigned int val; 1273ff1ec27SMark Brown int ret; 1283a66d387SMark Brown 129bf90e895STakashi Iwai if (WARN_ON(wm2000->anc_mode != ANC_OFF)) 130bf90e895STakashi Iwai return -EINVAL; 1313a66d387SMark Brown 1323a66d387SMark Brown dev_dbg(&i2c->dev, "Beginning power up\n"); 1333a66d387SMark Brown 134a89be93cSMark Brown ret = regulator_bulk_enable(WM2000_NUM_SUPPLIES, wm2000->supplies); 135a89be93cSMark Brown if (ret != 0) { 136a89be93cSMark Brown dev_err(&i2c->dev, "Failed to enable supplies: %d\n", ret); 137a89be93cSMark Brown return ret; 138a89be93cSMark Brown } 139a89be93cSMark Brown 140d61100bbSMark Brown rate = clk_get_rate(wm2000->mclk); 141d61100bbSMark Brown if (rate <= 13500000) { 1423a66d387SMark Brown dev_dbg(&i2c->dev, "Disabling MCLK divider\n"); 1433a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, 1443a66d387SMark Brown WM2000_MCLK_DIV2_ENA_CLR); 1453a66d387SMark Brown } else { 1463a66d387SMark Brown dev_dbg(&i2c->dev, "Enabling MCLK divider\n"); 1473a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, 1483a66d387SMark Brown WM2000_MCLK_DIV2_ENA_SET); 1493a66d387SMark Brown } 1503a66d387SMark Brown 1513a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_ENG_CLR); 1523a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_ENG_SET); 1533a66d387SMark Brown 1543a66d387SMark Brown /* Wait for ANC engine to become ready */ 1553a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_ANC_STAT, 1563ff1ec27SMark Brown WM2000_ANC_ENG_IDLE)) { 1573a66d387SMark Brown dev_err(&i2c->dev, "ANC engine failed to reset\n"); 158a89be93cSMark Brown regulator_bulk_disable(WM2000_NUM_SUPPLIES, wm2000->supplies); 1593a66d387SMark Brown return -ETIMEDOUT; 1603a66d387SMark Brown } 1613a66d387SMark Brown 1623a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS, 1633ff1ec27SMark Brown WM2000_STATUS_BOOT_COMPLETE)) { 1643a66d387SMark Brown dev_err(&i2c->dev, "ANC engine failed to initialise\n"); 165a89be93cSMark Brown regulator_bulk_disable(WM2000_NUM_SUPPLIES, wm2000->supplies); 1663a66d387SMark Brown return -ETIMEDOUT; 1673a66d387SMark Brown } 1683a66d387SMark Brown 1693a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_SET); 1703a66d387SMark Brown 1713a66d387SMark Brown /* Open code download of the data since it is the only bulk 1723a66d387SMark Brown * write we do. */ 1733a66d387SMark Brown dev_dbg(&i2c->dev, "Downloading %d bytes\n", 1743a66d387SMark Brown wm2000->anc_download_size - 2); 1753a66d387SMark Brown 1763a66d387SMark Brown ret = i2c_master_send(i2c, wm2000->anc_download, 1773a66d387SMark Brown wm2000->anc_download_size); 1783a66d387SMark Brown if (ret < 0) { 1793a66d387SMark Brown dev_err(&i2c->dev, "i2c_transfer() failed: %d\n", ret); 180a89be93cSMark Brown regulator_bulk_disable(WM2000_NUM_SUPPLIES, wm2000->supplies); 1813a66d387SMark Brown return ret; 1823a66d387SMark Brown } 1833a66d387SMark Brown if (ret != wm2000->anc_download_size) { 1843a66d387SMark Brown dev_err(&i2c->dev, "i2c_transfer() failed, %d != %d\n", 1853a66d387SMark Brown ret, wm2000->anc_download_size); 186a89be93cSMark Brown regulator_bulk_disable(WM2000_NUM_SUPPLIES, wm2000->supplies); 1873a66d387SMark Brown return -EIO; 1883a66d387SMark Brown } 1893a66d387SMark Brown 1903a66d387SMark Brown dev_dbg(&i2c->dev, "Download complete\n"); 1913a66d387SMark Brown 1923a66d387SMark Brown if (analogue) { 1933ff1ec27SMark Brown wm2000_write(i2c, WM2000_REG_ANA_VMID_PU_TIME, 248 / 4); 1943a66d387SMark Brown 1953a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 1963a66d387SMark Brown WM2000_MODE_ANA_SEQ_INCLUDE | 1973a66d387SMark Brown WM2000_MODE_MOUSE_ENABLE | 1983a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE); 1993a66d387SMark Brown } else { 2003a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 2013a66d387SMark Brown WM2000_MODE_MOUSE_ENABLE | 2023a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE); 2033a66d387SMark Brown } 2043a66d387SMark Brown 205c5d09485SLucas Tanure ret = regmap_read(wm2000->regmap, WM2000_REG_SPEECH_CLARITY, &val); 206c5d09485SLucas Tanure if (ret != 0) { 207c5d09485SLucas Tanure dev_err(&i2c->dev, "Unable to read Speech Clarity: %d\n", ret); 208c5d09485SLucas Tanure regulator_bulk_disable(WM2000_NUM_SUPPLIES, wm2000->supplies); 209c5d09485SLucas Tanure return ret; 210c5d09485SLucas Tanure } 2113a66d387SMark Brown if (wm2000->speech_clarity) 212c5d09485SLucas Tanure val |= WM2000_SPEECH_CLARITY; 213267f8fa2SMark Brown else 214c5d09485SLucas Tanure val &= ~WM2000_SPEECH_CLARITY; 215c5d09485SLucas Tanure wm2000_write(i2c, WM2000_REG_SPEECH_CLARITY, val); 2163a66d387SMark Brown 2173a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_START0, 0x33); 2183a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_START1, 0x02); 2193a66d387SMark Brown 2203a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_INT_N_CLR); 2213a66d387SMark Brown 2223a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS, 2233ff1ec27SMark Brown WM2000_STATUS_MOUSE_ACTIVE)) { 2243ff1ec27SMark Brown dev_err(&i2c->dev, "Timed out waiting for device\n"); 225a89be93cSMark Brown regulator_bulk_disable(WM2000_NUM_SUPPLIES, wm2000->supplies); 2263a66d387SMark Brown return -ETIMEDOUT; 2273a66d387SMark Brown } 2283a66d387SMark Brown 2293a66d387SMark Brown dev_dbg(&i2c->dev, "ANC active\n"); 2303a66d387SMark Brown if (analogue) 2313a66d387SMark Brown dev_dbg(&i2c->dev, "Analogue active\n"); 2323a66d387SMark Brown wm2000->anc_mode = ANC_ACTIVE; 2333a66d387SMark Brown 2343a66d387SMark Brown return 0; 2353a66d387SMark Brown } 2363a66d387SMark Brown 2373a66d387SMark Brown static int wm2000_power_down(struct i2c_client *i2c, int analogue) 2383a66d387SMark Brown { 2393a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 2403a66d387SMark Brown 2413a66d387SMark Brown if (analogue) { 2423ff1ec27SMark Brown wm2000_write(i2c, WM2000_REG_ANA_VMID_PD_TIME, 248 / 4); 2433a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 2443a66d387SMark Brown WM2000_MODE_ANA_SEQ_INCLUDE | 2453a66d387SMark Brown WM2000_MODE_POWER_DOWN); 2463a66d387SMark Brown } else { 2473a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 2483a66d387SMark Brown WM2000_MODE_POWER_DOWN); 2493a66d387SMark Brown } 2503a66d387SMark Brown 2513a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS, 2523ff1ec27SMark Brown WM2000_STATUS_POWER_DOWN_COMPLETE)) { 2533a66d387SMark Brown dev_err(&i2c->dev, "Timeout waiting for ANC power down\n"); 2543a66d387SMark Brown return -ETIMEDOUT; 2553a66d387SMark Brown } 2563a66d387SMark Brown 2573a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_ANC_STAT, 2583ff1ec27SMark Brown WM2000_ANC_ENG_IDLE)) { 2593a66d387SMark Brown dev_err(&i2c->dev, "Timeout waiting for ANC engine idle\n"); 2603a66d387SMark Brown return -ETIMEDOUT; 2613a66d387SMark Brown } 2623a66d387SMark Brown 263a89be93cSMark Brown regulator_bulk_disable(WM2000_NUM_SUPPLIES, wm2000->supplies); 264a89be93cSMark Brown 2653a66d387SMark Brown dev_dbg(&i2c->dev, "powered off\n"); 2663a66d387SMark Brown wm2000->anc_mode = ANC_OFF; 2673a66d387SMark Brown 2683a66d387SMark Brown return 0; 2693a66d387SMark Brown } 2703a66d387SMark Brown 2713a66d387SMark Brown static int wm2000_enter_bypass(struct i2c_client *i2c, int analogue) 2723a66d387SMark Brown { 2733a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 2743a66d387SMark Brown 275bf90e895STakashi Iwai if (WARN_ON(wm2000->anc_mode != ANC_ACTIVE)) 276bf90e895STakashi Iwai return -EINVAL; 2773a66d387SMark Brown 2783a66d387SMark Brown if (analogue) { 2793a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 2803a66d387SMark Brown WM2000_MODE_ANA_SEQ_INCLUDE | 2813a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE | 2823a66d387SMark Brown WM2000_MODE_BYPASS_ENTRY); 2833a66d387SMark Brown } else { 2843a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 2853a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE | 2863a66d387SMark Brown WM2000_MODE_BYPASS_ENTRY); 2873a66d387SMark Brown } 2883a66d387SMark Brown 2893a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS, 2903ff1ec27SMark Brown WM2000_STATUS_ANC_DISABLED)) { 2913a66d387SMark Brown dev_err(&i2c->dev, "Timeout waiting for ANC disable\n"); 2923a66d387SMark Brown return -ETIMEDOUT; 2933a66d387SMark Brown } 2943a66d387SMark Brown 2953a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_ANC_STAT, 2963ff1ec27SMark Brown WM2000_ANC_ENG_IDLE)) { 2973a66d387SMark Brown dev_err(&i2c->dev, "Timeout waiting for ANC engine idle\n"); 2983a66d387SMark Brown return -ETIMEDOUT; 2993a66d387SMark Brown } 3003a66d387SMark Brown 3013a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL1, WM2000_SYS_STBY); 3023a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_CLR); 3033a66d387SMark Brown 3043a66d387SMark Brown wm2000->anc_mode = ANC_BYPASS; 3053a66d387SMark Brown dev_dbg(&i2c->dev, "bypass enabled\n"); 3063a66d387SMark Brown 3073a66d387SMark Brown return 0; 3083a66d387SMark Brown } 3093a66d387SMark Brown 3103a66d387SMark Brown static int wm2000_exit_bypass(struct i2c_client *i2c, int analogue) 3113a66d387SMark Brown { 3123a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 3133a66d387SMark Brown 314bf90e895STakashi Iwai if (WARN_ON(wm2000->anc_mode != ANC_BYPASS)) 315bf90e895STakashi Iwai return -EINVAL; 3163a66d387SMark Brown 3173a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL1, 0); 3183a66d387SMark Brown 3193a66d387SMark Brown if (analogue) { 3203a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 3213a66d387SMark Brown WM2000_MODE_ANA_SEQ_INCLUDE | 3223a66d387SMark Brown WM2000_MODE_MOUSE_ENABLE | 3233a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE); 3243a66d387SMark Brown } else { 3253a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 3263a66d387SMark Brown WM2000_MODE_MOUSE_ENABLE | 3273a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE); 3283a66d387SMark Brown } 3293a66d387SMark Brown 3303a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_SET); 3313a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_INT_N_CLR); 3323a66d387SMark Brown 3333a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS, 3343ff1ec27SMark Brown WM2000_STATUS_MOUSE_ACTIVE)) { 3353a66d387SMark Brown dev_err(&i2c->dev, "Timed out waiting for MOUSE\n"); 3363a66d387SMark Brown return -ETIMEDOUT; 3373a66d387SMark Brown } 3383a66d387SMark Brown 3393a66d387SMark Brown wm2000->anc_mode = ANC_ACTIVE; 3403a66d387SMark Brown dev_dbg(&i2c->dev, "MOUSE active\n"); 3413a66d387SMark Brown 3423a66d387SMark Brown return 0; 3433a66d387SMark Brown } 3443a66d387SMark Brown 3453a66d387SMark Brown static int wm2000_enter_standby(struct i2c_client *i2c, int analogue) 3463a66d387SMark Brown { 3473a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 3483a66d387SMark Brown 349bf90e895STakashi Iwai if (WARN_ON(wm2000->anc_mode != ANC_ACTIVE)) 350bf90e895STakashi Iwai return -EINVAL; 3513a66d387SMark Brown 3523a66d387SMark Brown if (analogue) { 3533ff1ec27SMark Brown wm2000_write(i2c, WM2000_REG_ANA_VMID_PD_TIME, 248 / 4); 3543a66d387SMark Brown 3553a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 3563a66d387SMark Brown WM2000_MODE_ANA_SEQ_INCLUDE | 3573a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE | 3583a66d387SMark Brown WM2000_MODE_STANDBY_ENTRY); 3593a66d387SMark Brown } else { 3603a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 3613a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE | 3623a66d387SMark Brown WM2000_MODE_STANDBY_ENTRY); 3633a66d387SMark Brown } 3643a66d387SMark Brown 3653a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS, 3663ff1ec27SMark Brown WM2000_STATUS_ANC_DISABLED)) { 3673a66d387SMark Brown dev_err(&i2c->dev, 3683a66d387SMark Brown "Timed out waiting for ANC disable after 1ms\n"); 3693a66d387SMark Brown return -ETIMEDOUT; 3703a66d387SMark Brown } 3713a66d387SMark Brown 3723ff1ec27SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_ANC_STAT, WM2000_ANC_ENG_IDLE)) { 3733a66d387SMark Brown dev_err(&i2c->dev, 3743ff1ec27SMark Brown "Timed out waiting for standby\n"); 3753a66d387SMark Brown return -ETIMEDOUT; 3763a66d387SMark Brown } 3773a66d387SMark Brown 3783a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL1, WM2000_SYS_STBY); 3793a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_CLR); 3803a66d387SMark Brown 3813a66d387SMark Brown wm2000->anc_mode = ANC_STANDBY; 3823a66d387SMark Brown dev_dbg(&i2c->dev, "standby\n"); 3833a66d387SMark Brown if (analogue) 3843a66d387SMark Brown dev_dbg(&i2c->dev, "Analogue disabled\n"); 3853a66d387SMark Brown 3863a66d387SMark Brown return 0; 3873a66d387SMark Brown } 3883a66d387SMark Brown 3893a66d387SMark Brown static int wm2000_exit_standby(struct i2c_client *i2c, int analogue) 3903a66d387SMark Brown { 3913a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 3923a66d387SMark Brown 393bf90e895STakashi Iwai if (WARN_ON(wm2000->anc_mode != ANC_STANDBY)) 394bf90e895STakashi Iwai return -EINVAL; 3953a66d387SMark Brown 3963a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL1, 0); 3973a66d387SMark Brown 3983a66d387SMark Brown if (analogue) { 3993ff1ec27SMark Brown wm2000_write(i2c, WM2000_REG_ANA_VMID_PU_TIME, 248 / 4); 4003a66d387SMark Brown 4013a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 4023a66d387SMark Brown WM2000_MODE_ANA_SEQ_INCLUDE | 4033a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE | 4043a66d387SMark Brown WM2000_MODE_MOUSE_ENABLE); 4053a66d387SMark Brown } else { 4063a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 4073a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE | 4083a66d387SMark Brown WM2000_MODE_MOUSE_ENABLE); 4093a66d387SMark Brown } 4103a66d387SMark Brown 4113a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_SET); 4123a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_INT_N_CLR); 4133a66d387SMark Brown 4143a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS, 4153ff1ec27SMark Brown WM2000_STATUS_MOUSE_ACTIVE)) { 4163ff1ec27SMark Brown dev_err(&i2c->dev, "Timed out waiting for MOUSE\n"); 4173a66d387SMark Brown return -ETIMEDOUT; 4183a66d387SMark Brown } 4193a66d387SMark Brown 4203a66d387SMark Brown wm2000->anc_mode = ANC_ACTIVE; 4213a66d387SMark Brown dev_dbg(&i2c->dev, "MOUSE active\n"); 4223a66d387SMark Brown if (analogue) 4233a66d387SMark Brown dev_dbg(&i2c->dev, "Analogue enabled\n"); 4243a66d387SMark Brown 4253a66d387SMark Brown return 0; 4263a66d387SMark Brown } 4273a66d387SMark Brown 4283a66d387SMark Brown typedef int (*wm2000_mode_fn)(struct i2c_client *i2c, int analogue); 4293a66d387SMark Brown 4303a66d387SMark Brown static struct { 4313a66d387SMark Brown enum wm2000_anc_mode source; 4323a66d387SMark Brown enum wm2000_anc_mode dest; 4333a66d387SMark Brown int analogue; 4343a66d387SMark Brown wm2000_mode_fn step[2]; 4353a66d387SMark Brown } anc_transitions[] = { 4363a66d387SMark Brown { 4373a66d387SMark Brown .source = ANC_OFF, 4383a66d387SMark Brown .dest = ANC_ACTIVE, 4393a66d387SMark Brown .analogue = 1, 4403a66d387SMark Brown .step = { 4413a66d387SMark Brown wm2000_power_up, 4423a66d387SMark Brown }, 4433a66d387SMark Brown }, 4443a66d387SMark Brown { 4453a66d387SMark Brown .source = ANC_OFF, 4463a66d387SMark Brown .dest = ANC_STANDBY, 4473a66d387SMark Brown .step = { 4483a66d387SMark Brown wm2000_power_up, 4493a66d387SMark Brown wm2000_enter_standby, 4503a66d387SMark Brown }, 4513a66d387SMark Brown }, 4523a66d387SMark Brown { 4533a66d387SMark Brown .source = ANC_OFF, 4543a66d387SMark Brown .dest = ANC_BYPASS, 4553a66d387SMark Brown .analogue = 1, 4563a66d387SMark Brown .step = { 4573a66d387SMark Brown wm2000_power_up, 4583a66d387SMark Brown wm2000_enter_bypass, 4593a66d387SMark Brown }, 4603a66d387SMark Brown }, 4613a66d387SMark Brown { 4623a66d387SMark Brown .source = ANC_ACTIVE, 4633a66d387SMark Brown .dest = ANC_BYPASS, 4643a66d387SMark Brown .analogue = 1, 4653a66d387SMark Brown .step = { 4663a66d387SMark Brown wm2000_enter_bypass, 4673a66d387SMark Brown }, 4683a66d387SMark Brown }, 4693a66d387SMark Brown { 4703a66d387SMark Brown .source = ANC_ACTIVE, 4713a66d387SMark Brown .dest = ANC_STANDBY, 4723a66d387SMark Brown .analogue = 1, 4733a66d387SMark Brown .step = { 4743a66d387SMark Brown wm2000_enter_standby, 4753a66d387SMark Brown }, 4763a66d387SMark Brown }, 4773a66d387SMark Brown { 4783a66d387SMark Brown .source = ANC_ACTIVE, 4793a66d387SMark Brown .dest = ANC_OFF, 4803a66d387SMark Brown .analogue = 1, 4813a66d387SMark Brown .step = { 4823a66d387SMark Brown wm2000_power_down, 4833a66d387SMark Brown }, 4843a66d387SMark Brown }, 4853a66d387SMark Brown { 4863a66d387SMark Brown .source = ANC_BYPASS, 4873a66d387SMark Brown .dest = ANC_ACTIVE, 4883a66d387SMark Brown .analogue = 1, 4893a66d387SMark Brown .step = { 4903a66d387SMark Brown wm2000_exit_bypass, 4913a66d387SMark Brown }, 4923a66d387SMark Brown }, 4933a66d387SMark Brown { 4943a66d387SMark Brown .source = ANC_BYPASS, 4953a66d387SMark Brown .dest = ANC_STANDBY, 4963a66d387SMark Brown .analogue = 1, 4973a66d387SMark Brown .step = { 4983a66d387SMark Brown wm2000_exit_bypass, 4993a66d387SMark Brown wm2000_enter_standby, 5003a66d387SMark Brown }, 5013a66d387SMark Brown }, 5023a66d387SMark Brown { 5033a66d387SMark Brown .source = ANC_BYPASS, 5043a66d387SMark Brown .dest = ANC_OFF, 5053a66d387SMark Brown .step = { 5063a66d387SMark Brown wm2000_exit_bypass, 5073a66d387SMark Brown wm2000_power_down, 5083a66d387SMark Brown }, 5093a66d387SMark Brown }, 5103a66d387SMark Brown { 5113a66d387SMark Brown .source = ANC_STANDBY, 5123a66d387SMark Brown .dest = ANC_ACTIVE, 5133a66d387SMark Brown .analogue = 1, 5143a66d387SMark Brown .step = { 5153a66d387SMark Brown wm2000_exit_standby, 5163a66d387SMark Brown }, 5173a66d387SMark Brown }, 5183a66d387SMark Brown { 5193a66d387SMark Brown .source = ANC_STANDBY, 5203a66d387SMark Brown .dest = ANC_BYPASS, 5213a66d387SMark Brown .analogue = 1, 5223a66d387SMark Brown .step = { 5233a66d387SMark Brown wm2000_exit_standby, 5243a66d387SMark Brown wm2000_enter_bypass, 5253a66d387SMark Brown }, 5263a66d387SMark Brown }, 5273a66d387SMark Brown { 5283a66d387SMark Brown .source = ANC_STANDBY, 5293a66d387SMark Brown .dest = ANC_OFF, 5303a66d387SMark Brown .step = { 5313a66d387SMark Brown wm2000_exit_standby, 5323a66d387SMark Brown wm2000_power_down, 5333a66d387SMark Brown }, 5343a66d387SMark Brown }, 5353a66d387SMark Brown }; 5363a66d387SMark Brown 5373a66d387SMark Brown static int wm2000_anc_transition(struct wm2000_priv *wm2000, 5383a66d387SMark Brown enum wm2000_anc_mode mode) 5393a66d387SMark Brown { 5403a66d387SMark Brown struct i2c_client *i2c = wm2000->i2c; 5413a66d387SMark Brown int i, j; 5423a66d387SMark Brown int ret; 5433a66d387SMark Brown 5443a66d387SMark Brown if (wm2000->anc_mode == mode) 5453a66d387SMark Brown return 0; 5463a66d387SMark Brown 5473a66d387SMark Brown for (i = 0; i < ARRAY_SIZE(anc_transitions); i++) 5483a66d387SMark Brown if (anc_transitions[i].source == wm2000->anc_mode && 5493a66d387SMark Brown anc_transitions[i].dest == mode) 5503a66d387SMark Brown break; 5513a66d387SMark Brown if (i == ARRAY_SIZE(anc_transitions)) { 5523a66d387SMark Brown dev_err(&i2c->dev, "No transition for %d->%d\n", 5533a66d387SMark Brown wm2000->anc_mode, mode); 5543a66d387SMark Brown return -EINVAL; 5553a66d387SMark Brown } 5563a66d387SMark Brown 557514cfd6dSMark Brown /* Maintain clock while active */ 558514cfd6dSMark Brown if (anc_transitions[i].source == ANC_OFF) { 559514cfd6dSMark Brown ret = clk_prepare_enable(wm2000->mclk); 560514cfd6dSMark Brown if (ret != 0) { 561514cfd6dSMark Brown dev_err(&i2c->dev, "Failed to enable MCLK: %d\n", ret); 562514cfd6dSMark Brown return ret; 563514cfd6dSMark Brown } 564514cfd6dSMark Brown } 565514cfd6dSMark Brown 5663a66d387SMark Brown for (j = 0; j < ARRAY_SIZE(anc_transitions[j].step); j++) { 5673a66d387SMark Brown if (!anc_transitions[i].step[j]) 5683a66d387SMark Brown break; 5693a66d387SMark Brown ret = anc_transitions[i].step[j](i2c, 5703a66d387SMark Brown anc_transitions[i].analogue); 5713a66d387SMark Brown if (ret != 0) 5723a66d387SMark Brown return ret; 5733a66d387SMark Brown } 5743a66d387SMark Brown 575514cfd6dSMark Brown if (anc_transitions[i].dest == ANC_OFF) 576514cfd6dSMark Brown clk_disable_unprepare(wm2000->mclk); 577514cfd6dSMark Brown 578fa54aadeSCharles Keepax return 0; 5793a66d387SMark Brown } 5803a66d387SMark Brown 5813a66d387SMark Brown static int wm2000_anc_set_mode(struct wm2000_priv *wm2000) 5823a66d387SMark Brown { 5833a66d387SMark Brown struct i2c_client *i2c = wm2000->i2c; 5843a66d387SMark Brown enum wm2000_anc_mode mode; 5853a66d387SMark Brown 5863a66d387SMark Brown if (wm2000->anc_eng_ena && wm2000->spk_ena) 5873a66d387SMark Brown if (wm2000->anc_active) 5883a66d387SMark Brown mode = ANC_ACTIVE; 5893a66d387SMark Brown else 5903a66d387SMark Brown mode = ANC_BYPASS; 5913a66d387SMark Brown else 5923a66d387SMark Brown mode = ANC_STANDBY; 5933a66d387SMark Brown 5943a66d387SMark Brown dev_dbg(&i2c->dev, "Set mode %d (enabled %d, mute %d, active %d)\n", 5953a66d387SMark Brown mode, wm2000->anc_eng_ena, !wm2000->spk_ena, 5963a66d387SMark Brown wm2000->anc_active); 5973a66d387SMark Brown 5983a66d387SMark Brown return wm2000_anc_transition(wm2000, mode); 5993a66d387SMark Brown } 6003a66d387SMark Brown 6013a66d387SMark Brown static int wm2000_anc_mode_get(struct snd_kcontrol *kcontrol, 6023a66d387SMark Brown struct snd_ctl_elem_value *ucontrol) 6033a66d387SMark Brown { 604e5449affSKuninori Morimoto struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 605e5449affSKuninori Morimoto struct wm2000_priv *wm2000 = dev_get_drvdata(component->dev); 6063a66d387SMark Brown 60700a14c29STakashi Iwai ucontrol->value.integer.value[0] = wm2000->anc_active; 6083a66d387SMark Brown 6093a66d387SMark Brown return 0; 6103a66d387SMark Brown } 6113a66d387SMark Brown 6123a66d387SMark Brown static int wm2000_anc_mode_put(struct snd_kcontrol *kcontrol, 6133a66d387SMark Brown struct snd_ctl_elem_value *ucontrol) 6143a66d387SMark Brown { 615e5449affSKuninori Morimoto struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 616e5449affSKuninori Morimoto struct wm2000_priv *wm2000 = dev_get_drvdata(component->dev); 6178444f59fSDan Carpenter unsigned int anc_active = ucontrol->value.integer.value[0]; 6188e9bb423SMark Brown int ret; 6193a66d387SMark Brown 6203a66d387SMark Brown if (anc_active > 1) 6213a66d387SMark Brown return -EINVAL; 6223a66d387SMark Brown 6238e9bb423SMark Brown mutex_lock(&wm2000->lock); 6248e9bb423SMark Brown 6253a66d387SMark Brown wm2000->anc_active = anc_active; 6263a66d387SMark Brown 6278e9bb423SMark Brown ret = wm2000_anc_set_mode(wm2000); 6288e9bb423SMark Brown 6298e9bb423SMark Brown mutex_unlock(&wm2000->lock); 6308e9bb423SMark Brown 6318e9bb423SMark Brown return ret; 6323a66d387SMark Brown } 6333a66d387SMark Brown 6343a66d387SMark Brown static int wm2000_speaker_get(struct snd_kcontrol *kcontrol, 6353a66d387SMark Brown struct snd_ctl_elem_value *ucontrol) 6363a66d387SMark Brown { 637e5449affSKuninori Morimoto struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 638e5449affSKuninori Morimoto struct wm2000_priv *wm2000 = dev_get_drvdata(component->dev); 6393a66d387SMark Brown 64000a14c29STakashi Iwai ucontrol->value.integer.value[0] = wm2000->spk_ena; 6413a66d387SMark Brown 6423a66d387SMark Brown return 0; 6433a66d387SMark Brown } 6443a66d387SMark Brown 6453a66d387SMark Brown static int wm2000_speaker_put(struct snd_kcontrol *kcontrol, 6463a66d387SMark Brown struct snd_ctl_elem_value *ucontrol) 6473a66d387SMark Brown { 648e5449affSKuninori Morimoto struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 649e5449affSKuninori Morimoto struct wm2000_priv *wm2000 = dev_get_drvdata(component->dev); 6508444f59fSDan Carpenter unsigned int val = ucontrol->value.integer.value[0]; 6518e9bb423SMark Brown int ret; 6523a66d387SMark Brown 6533a66d387SMark Brown if (val > 1) 6543a66d387SMark Brown return -EINVAL; 6553a66d387SMark Brown 6568e9bb423SMark Brown mutex_lock(&wm2000->lock); 6578e9bb423SMark Brown 6583a66d387SMark Brown wm2000->spk_ena = val; 6593a66d387SMark Brown 6608e9bb423SMark Brown ret = wm2000_anc_set_mode(wm2000); 6618e9bb423SMark Brown 6628e9bb423SMark Brown mutex_unlock(&wm2000->lock); 6638e9bb423SMark Brown 6648e9bb423SMark Brown return ret; 6653a66d387SMark Brown } 6663a66d387SMark Brown 6673a66d387SMark Brown static const struct snd_kcontrol_new wm2000_controls[] = { 6683f3af6eeSMark Brown SOC_SINGLE("ANC Volume", WM2000_REG_ANC_GAIN_CTRL, 0, 255, 0), 6693a66d387SMark Brown SOC_SINGLE_BOOL_EXT("WM2000 ANC Switch", 0, 6703a66d387SMark Brown wm2000_anc_mode_get, 6713a66d387SMark Brown wm2000_anc_mode_put), 6723a66d387SMark Brown SOC_SINGLE_BOOL_EXT("WM2000 Switch", 0, 6733a66d387SMark Brown wm2000_speaker_get, 6743a66d387SMark Brown wm2000_speaker_put), 6753a66d387SMark Brown }; 6763a66d387SMark Brown 6773a66d387SMark Brown static int wm2000_anc_power_event(struct snd_soc_dapm_widget *w, 6783a66d387SMark Brown struct snd_kcontrol *kcontrol, int event) 6793a66d387SMark Brown { 680e5449affSKuninori Morimoto struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 681e5449affSKuninori Morimoto struct wm2000_priv *wm2000 = dev_get_drvdata(component->dev); 6828e9bb423SMark Brown int ret; 6838e9bb423SMark Brown 6848e9bb423SMark Brown mutex_lock(&wm2000->lock); 6853a66d387SMark Brown 6863a66d387SMark Brown if (SND_SOC_DAPM_EVENT_ON(event)) 6873a66d387SMark Brown wm2000->anc_eng_ena = 1; 6883a66d387SMark Brown 6893a66d387SMark Brown if (SND_SOC_DAPM_EVENT_OFF(event)) 6903a66d387SMark Brown wm2000->anc_eng_ena = 0; 6913a66d387SMark Brown 6928e9bb423SMark Brown ret = wm2000_anc_set_mode(wm2000); 6938e9bb423SMark Brown 6948e9bb423SMark Brown mutex_unlock(&wm2000->lock); 6958e9bb423SMark Brown 6968e9bb423SMark Brown return ret; 6973a66d387SMark Brown } 6983a66d387SMark Brown 6993a66d387SMark Brown static const struct snd_soc_dapm_widget wm2000_dapm_widgets[] = { 7003a66d387SMark Brown /* Externally visible pins */ 7014911ccdbSMark Brown SND_SOC_DAPM_OUTPUT("SPKN"), 7024911ccdbSMark Brown SND_SOC_DAPM_OUTPUT("SPKP"), 7033a66d387SMark Brown 7044911ccdbSMark Brown SND_SOC_DAPM_INPUT("LINN"), 7054911ccdbSMark Brown SND_SOC_DAPM_INPUT("LINP"), 7063a66d387SMark Brown 7073a66d387SMark Brown SND_SOC_DAPM_PGA_E("ANC Engine", SND_SOC_NOPM, 0, 0, NULL, 0, 7083a66d387SMark Brown wm2000_anc_power_event, 7093a66d387SMark Brown SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD), 7103a66d387SMark Brown }; 7113a66d387SMark Brown 7123a66d387SMark Brown /* Target, Path, Source */ 7134911ccdbSMark Brown static const struct snd_soc_dapm_route wm2000_audio_map[] = { 7144911ccdbSMark Brown { "SPKN", NULL, "ANC Engine" }, 7154911ccdbSMark Brown { "SPKP", NULL, "ANC Engine" }, 7164911ccdbSMark Brown { "ANC Engine", NULL, "LINN" }, 7174911ccdbSMark Brown { "ANC Engine", NULL, "LINP" }, 7183a66d387SMark Brown }; 7193a66d387SMark Brown 7204911ccdbSMark Brown #ifdef CONFIG_PM 721e5449affSKuninori Morimoto static int wm2000_suspend(struct snd_soc_component *component) 7223a66d387SMark Brown { 723e5449affSKuninori Morimoto struct wm2000_priv *wm2000 = dev_get_drvdata(component->dev); 7243a66d387SMark Brown 7254911ccdbSMark Brown return wm2000_anc_transition(wm2000, ANC_OFF); 7263a66d387SMark Brown } 7273a66d387SMark Brown 728e5449affSKuninori Morimoto static int wm2000_resume(struct snd_soc_component *component) 7294911ccdbSMark Brown { 730e5449affSKuninori Morimoto struct wm2000_priv *wm2000 = dev_get_drvdata(component->dev); 7313a66d387SMark Brown 7324911ccdbSMark Brown return wm2000_anc_set_mode(wm2000); 7333a66d387SMark Brown } 7344911ccdbSMark Brown #else 7354911ccdbSMark Brown #define wm2000_suspend NULL 7364911ccdbSMark Brown #define wm2000_resume NULL 7374911ccdbSMark Brown #endif 7383a66d387SMark Brown 73951cc7ed3SMark Brown static bool wm2000_readable_reg(struct device *dev, unsigned int reg) 74051cc7ed3SMark Brown { 74151cc7ed3SMark Brown switch (reg) { 74251cc7ed3SMark Brown case WM2000_REG_SYS_START: 74333e7546eSMark Brown case WM2000_REG_ANC_GAIN_CTRL: 74433e7546eSMark Brown case WM2000_REG_MSE_TH1: 74533e7546eSMark Brown case WM2000_REG_MSE_TH2: 74651cc7ed3SMark Brown case WM2000_REG_SPEECH_CLARITY: 74751cc7ed3SMark Brown case WM2000_REG_SYS_WATCHDOG: 74851cc7ed3SMark Brown case WM2000_REG_ANA_VMID_PD_TIME: 74951cc7ed3SMark Brown case WM2000_REG_ANA_VMID_PU_TIME: 75051cc7ed3SMark Brown case WM2000_REG_CAT_FLTR_INDX: 75151cc7ed3SMark Brown case WM2000_REG_CAT_GAIN_0: 75251cc7ed3SMark Brown case WM2000_REG_SYS_STATUS: 75351cc7ed3SMark Brown case WM2000_REG_SYS_MODE_CNTRL: 75451cc7ed3SMark Brown case WM2000_REG_SYS_START0: 75551cc7ed3SMark Brown case WM2000_REG_SYS_START1: 75651cc7ed3SMark Brown case WM2000_REG_ID1: 75751cc7ed3SMark Brown case WM2000_REG_ID2: 75851cc7ed3SMark Brown case WM2000_REG_REVISON: 75951cc7ed3SMark Brown case WM2000_REG_SYS_CTL1: 76051cc7ed3SMark Brown case WM2000_REG_SYS_CTL2: 76151cc7ed3SMark Brown case WM2000_REG_ANC_STAT: 76251cc7ed3SMark Brown case WM2000_REG_IF_CTL: 763939dc51bSMark Brown case WM2000_REG_ANA_MIC_CTL: 764939dc51bSMark Brown case WM2000_REG_SPK_CTL: 76551cc7ed3SMark Brown return true; 76651cc7ed3SMark Brown default: 76751cc7ed3SMark Brown return false; 76851cc7ed3SMark Brown } 76951cc7ed3SMark Brown } 77051cc7ed3SMark Brown 7718aa1fe81SMark Brown static const struct regmap_config wm2000_regmap = { 772d0e12f3fSMark Brown .reg_bits = 16, 7738aa1fe81SMark Brown .val_bits = 8, 77451cc7ed3SMark Brown 775939dc51bSMark Brown .max_register = WM2000_REG_SPK_CTL, 77651cc7ed3SMark Brown .readable_reg = wm2000_readable_reg, 7778aa1fe81SMark Brown }; 7788aa1fe81SMark Brown 779e5449affSKuninori Morimoto static int wm2000_probe(struct snd_soc_component *component) 7804911ccdbSMark Brown { 781e5449affSKuninori Morimoto struct wm2000_priv *wm2000 = dev_get_drvdata(component->dev); 7824911ccdbSMark Brown 7834911ccdbSMark Brown /* This will trigger a transition to standby mode by default */ 7844911ccdbSMark Brown wm2000_anc_set_mode(wm2000); 7854911ccdbSMark Brown 7864911ccdbSMark Brown return 0; 7874911ccdbSMark Brown } 7884911ccdbSMark Brown 789e5449affSKuninori Morimoto static void wm2000_remove(struct snd_soc_component *component) 7904911ccdbSMark Brown { 791e5449affSKuninori Morimoto struct wm2000_priv *wm2000 = dev_get_drvdata(component->dev); 7924911ccdbSMark Brown 793e5449affSKuninori Morimoto wm2000_anc_transition(wm2000, ANC_OFF); 7944911ccdbSMark Brown } 7954911ccdbSMark Brown 796e5449affSKuninori Morimoto static const struct snd_soc_component_driver soc_component_dev_wm2000 = { 7974911ccdbSMark Brown .probe = wm2000_probe, 7984911ccdbSMark Brown .remove = wm2000_remove, 7994911ccdbSMark Brown .suspend = wm2000_suspend, 8004911ccdbSMark Brown .resume = wm2000_resume, 801bd22e11eSKuninori Morimoto .controls = wm2000_controls, 802bd22e11eSKuninori Morimoto .num_controls = ARRAY_SIZE(wm2000_controls), 8034911ccdbSMark Brown .dapm_widgets = wm2000_dapm_widgets, 8044911ccdbSMark Brown .num_dapm_widgets = ARRAY_SIZE(wm2000_dapm_widgets), 8054911ccdbSMark Brown .dapm_routes = wm2000_audio_map, 8064911ccdbSMark Brown .num_dapm_routes = ARRAY_SIZE(wm2000_audio_map), 807e5449affSKuninori Morimoto .idle_bias_on = 1, 808e5449affSKuninori Morimoto .use_pmdown_time = 1, 809e5449affSKuninori Morimoto .endianness = 1, 810e5449affSKuninori Morimoto .non_legacy_dai_naming = 1, 8114911ccdbSMark Brown }; 8124911ccdbSMark Brown 8137a79e94eSBill Pemberton static int wm2000_i2c_probe(struct i2c_client *i2c, 8143a66d387SMark Brown const struct i2c_device_id *i2c_id) 8153a66d387SMark Brown { 8163a66d387SMark Brown struct wm2000_priv *wm2000; 8173a66d387SMark Brown struct wm2000_platform_data *pdata; 8183a66d387SMark Brown const char *filename; 819c83f1d7eSJesper Juhl const struct firmware *fw = NULL; 820a89be93cSMark Brown int ret, i; 821c5d09485SLucas Tanure unsigned int reg; 8223a66d387SMark Brown u16 id; 8233a66d387SMark Brown 824bf0842baSMarkus Elfring wm2000 = devm_kzalloc(&i2c->dev, sizeof(*wm2000), GFP_KERNEL); 825a0f62118SSachin Kamat if (!wm2000) 8263a66d387SMark Brown return -ENOMEM; 8273a66d387SMark Brown 8288e9bb423SMark Brown mutex_init(&wm2000->lock); 8298e9bb423SMark Brown 8308aa1fe81SMark Brown dev_set_drvdata(&i2c->dev, wm2000); 8318aa1fe81SMark Brown 8328fed54aeSMark Brown wm2000->regmap = devm_regmap_init_i2c(i2c, &wm2000_regmap); 8338aa1fe81SMark Brown if (IS_ERR(wm2000->regmap)) { 8348aa1fe81SMark Brown ret = PTR_ERR(wm2000->regmap); 8358aa1fe81SMark Brown dev_err(&i2c->dev, "Failed to allocate register map: %d\n", 8368aa1fe81SMark Brown ret); 837c83f1d7eSJesper Juhl goto out; 8388aa1fe81SMark Brown } 8398aa1fe81SMark Brown 840a89be93cSMark Brown for (i = 0; i < WM2000_NUM_SUPPLIES; i++) 841a89be93cSMark Brown wm2000->supplies[i].supply = wm2000_supplies[i]; 842a89be93cSMark Brown 843a89be93cSMark Brown ret = devm_regulator_bulk_get(&i2c->dev, WM2000_NUM_SUPPLIES, 844a89be93cSMark Brown wm2000->supplies); 845a89be93cSMark Brown if (ret != 0) { 846a89be93cSMark Brown dev_err(&i2c->dev, "Failed to get supplies: %d\n", ret); 847a89be93cSMark Brown return ret; 848a89be93cSMark Brown } 849a89be93cSMark Brown 850a89be93cSMark Brown ret = regulator_bulk_enable(WM2000_NUM_SUPPLIES, wm2000->supplies); 851a89be93cSMark Brown if (ret != 0) { 852a89be93cSMark Brown dev_err(&i2c->dev, "Failed to enable supplies: %d\n", ret); 853a89be93cSMark Brown return ret; 854a89be93cSMark Brown } 855a89be93cSMark Brown 8563a66d387SMark Brown /* Verify that this is a WM2000 */ 857c5d09485SLucas Tanure ret = regmap_read(wm2000->regmap, WM2000_REG_ID1, ®); 858c5d09485SLucas Tanure if (ret != 0) { 859c5d09485SLucas Tanure dev_err(&i2c->dev, "Unable to read ID1: %d\n", ret); 860c5d09485SLucas Tanure return ret; 861c5d09485SLucas Tanure } 8623a66d387SMark Brown id = reg << 8; 863c5d09485SLucas Tanure ret = regmap_read(wm2000->regmap, WM2000_REG_ID2, ®); 864c5d09485SLucas Tanure if (ret != 0) { 865c5d09485SLucas Tanure dev_err(&i2c->dev, "Unable to read ID2: %d\n", ret); 866c5d09485SLucas Tanure return ret; 867c5d09485SLucas Tanure } 8683a66d387SMark Brown id |= reg & 0xff; 8693a66d387SMark Brown 8703a66d387SMark Brown if (id != 0x2000) { 8713a66d387SMark Brown dev_err(&i2c->dev, "Device is not a WM2000 - ID %x\n", id); 8723a66d387SMark Brown ret = -ENODEV; 873a89be93cSMark Brown goto err_supplies; 8743a66d387SMark Brown } 8753a66d387SMark Brown 876c5d09485SLucas Tanure ret = regmap_read(wm2000->regmap, WM2000_REG_REVISON, ®); 877c5d09485SLucas Tanure if (ret != 0) { 878c5d09485SLucas Tanure dev_err(&i2c->dev, "Unable to read Revision: %d\n", ret); 879c5d09485SLucas Tanure return ret; 880c5d09485SLucas Tanure } 8813a66d387SMark Brown dev_info(&i2c->dev, "revision %c\n", reg + 'A'); 8823a66d387SMark Brown 883514cfd6dSMark Brown wm2000->mclk = devm_clk_get(&i2c->dev, "MCLK"); 884514cfd6dSMark Brown if (IS_ERR(wm2000->mclk)) { 885514cfd6dSMark Brown ret = PTR_ERR(wm2000->mclk); 886514cfd6dSMark Brown dev_err(&i2c->dev, "Failed to get MCLK: %d\n", ret); 887514cfd6dSMark Brown goto err_supplies; 888514cfd6dSMark Brown } 889514cfd6dSMark Brown 8903a66d387SMark Brown filename = "wm2000_anc.bin"; 8913a66d387SMark Brown pdata = dev_get_platdata(&i2c->dev); 8923a66d387SMark Brown if (pdata) { 8933a66d387SMark Brown wm2000->speech_clarity = !pdata->speech_enh_disable; 8943a66d387SMark Brown 8953a66d387SMark Brown if (pdata->download_file) 8963a66d387SMark Brown filename = pdata->download_file; 8973a66d387SMark Brown } 8983a66d387SMark Brown 8993a66d387SMark Brown ret = request_firmware(&fw, filename, &i2c->dev); 9003a66d387SMark Brown if (ret != 0) { 9013a66d387SMark Brown dev_err(&i2c->dev, "Failed to acquire ANC data: %d\n", ret); 902a89be93cSMark Brown goto err_supplies; 9033a66d387SMark Brown } 9043a66d387SMark Brown 9053a66d387SMark Brown /* Pre-cook the concatenation of the register address onto the image */ 9063a66d387SMark Brown wm2000->anc_download_size = fw->size + 2; 907b03e96e4SMark Brown wm2000->anc_download = devm_kzalloc(&i2c->dev, 908b03e96e4SMark Brown wm2000->anc_download_size, 909b03e96e4SMark Brown GFP_KERNEL); 9103a66d387SMark Brown if (wm2000->anc_download == NULL) { 9113a66d387SMark Brown ret = -ENOMEM; 912a89be93cSMark Brown goto err_supplies; 9133a66d387SMark Brown } 9143a66d387SMark Brown 9153a66d387SMark Brown wm2000->anc_download[0] = 0x80; 9163a66d387SMark Brown wm2000->anc_download[1] = 0x00; 9173a66d387SMark Brown memcpy(wm2000->anc_download + 2, fw->data, fw->size); 9183a66d387SMark Brown 9193a66d387SMark Brown wm2000->anc_eng_ena = 1; 920e71fa370SMark Brown wm2000->anc_active = 1; 921e71fa370SMark Brown wm2000->spk_ena = 1; 9223a66d387SMark Brown wm2000->i2c = i2c; 9233a66d387SMark Brown 9243a66d387SMark Brown wm2000_reset(wm2000); 9253a66d387SMark Brown 926e5449affSKuninori Morimoto ret = devm_snd_soc_register_component(&i2c->dev, 927e5449affSKuninori Morimoto &soc_component_dev_wm2000, NULL, 0); 9283a66d387SMark Brown 929a89be93cSMark Brown err_supplies: 930a89be93cSMark Brown regulator_bulk_disable(WM2000_NUM_SUPPLIES, wm2000->supplies); 9313a66d387SMark Brown 932c83f1d7eSJesper Juhl out: 933c83f1d7eSJesper Juhl release_firmware(fw); 9343a66d387SMark Brown return ret; 9353a66d387SMark Brown } 9363a66d387SMark Brown 9373a66d387SMark Brown static const struct i2c_device_id wm2000_i2c_id[] = { 9383a66d387SMark Brown { "wm2000", 0 }, 9393a66d387SMark Brown { } 9403a66d387SMark Brown }; 9413a66d387SMark Brown MODULE_DEVICE_TABLE(i2c, wm2000_i2c_id); 9423a66d387SMark Brown 9433a66d387SMark Brown static struct i2c_driver wm2000_i2c_driver = { 9443a66d387SMark Brown .driver = { 9453a66d387SMark Brown .name = "wm2000", 9463a66d387SMark Brown }, 9473a66d387SMark Brown .probe = wm2000_i2c_probe, 9483a66d387SMark Brown .id_table = wm2000_i2c_id, 9493a66d387SMark Brown }; 9503a66d387SMark Brown 9513a4bfd88SSachin Kamat module_i2c_driver(wm2000_i2c_driver); 9523a66d387SMark Brown 9533a66d387SMark Brown MODULE_DESCRIPTION("ASoC WM2000 driver"); 9543a66d387SMark Brown MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfonmicro.com>"); 9553a66d387SMark Brown MODULE_LICENSE("GPL"); 956