13a66d387SMark Brown /* 23a66d387SMark Brown * wm2000.c -- WM2000 ALSA Soc Audio driver 33a66d387SMark Brown * 43a66d387SMark Brown * Copyright 2008-2010 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 163a66d387SMark Brown * system-specific callibration 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> 293a66d387SMark Brown #include <linux/delay.h> 303a66d387SMark Brown #include <linux/pm.h> 313a66d387SMark Brown #include <linux/i2c.h> 323a66d387SMark Brown #include <linux/platform_device.h> 333a66d387SMark Brown #include <linux/debugfs.h> 345a0e3ad6STejun Heo #include <linux/slab.h> 353a66d387SMark Brown #include <sound/core.h> 363a66d387SMark Brown #include <sound/pcm.h> 373a66d387SMark Brown #include <sound/pcm_params.h> 383a66d387SMark Brown #include <sound/soc.h> 393a66d387SMark Brown #include <sound/initval.h> 403a66d387SMark Brown #include <sound/tlv.h> 413a66d387SMark Brown 423a66d387SMark Brown #include <sound/wm2000.h> 433a66d387SMark Brown 443a66d387SMark Brown #include "wm2000.h" 453a66d387SMark Brown 463a66d387SMark Brown enum wm2000_anc_mode { 473a66d387SMark Brown ANC_ACTIVE = 0, 483a66d387SMark Brown ANC_BYPASS = 1, 493a66d387SMark Brown ANC_STANDBY = 2, 503a66d387SMark Brown ANC_OFF = 3, 513a66d387SMark Brown }; 523a66d387SMark Brown 533a66d387SMark Brown struct wm2000_priv { 543a66d387SMark Brown struct i2c_client *i2c; 553a66d387SMark Brown 563a66d387SMark Brown enum wm2000_anc_mode anc_mode; 573a66d387SMark Brown 583a66d387SMark Brown unsigned int anc_active:1; 593a66d387SMark Brown unsigned int anc_eng_ena:1; 603a66d387SMark Brown unsigned int spk_ena:1; 613a66d387SMark Brown 623a66d387SMark Brown unsigned int mclk_div:1; 633a66d387SMark Brown unsigned int speech_clarity:1; 643a66d387SMark Brown 653a66d387SMark Brown int anc_download_size; 663a66d387SMark Brown char *anc_download; 673a66d387SMark Brown }; 683a66d387SMark Brown 693a66d387SMark Brown static struct i2c_client *wm2000_i2c; 703a66d387SMark Brown 713a66d387SMark Brown static int wm2000_write(struct i2c_client *i2c, unsigned int reg, 723a66d387SMark Brown unsigned int value) 733a66d387SMark Brown { 743a66d387SMark Brown u8 data[3]; 753a66d387SMark Brown int ret; 763a66d387SMark Brown 773a66d387SMark Brown data[0] = (reg >> 8) & 0xff; 783a66d387SMark Brown data[1] = reg & 0xff; 793a66d387SMark Brown data[2] = value & 0xff; 803a66d387SMark Brown 813a66d387SMark Brown dev_vdbg(&i2c->dev, "write %x = %x\n", reg, value); 823a66d387SMark Brown 833a66d387SMark Brown ret = i2c_master_send(i2c, data, 3); 843a66d387SMark Brown if (ret == 3) 853a66d387SMark Brown return 0; 863a66d387SMark Brown if (ret < 0) 873a66d387SMark Brown return ret; 883a66d387SMark Brown else 893a66d387SMark Brown return -EIO; 903a66d387SMark Brown } 913a66d387SMark Brown 923a66d387SMark Brown static unsigned int wm2000_read(struct i2c_client *i2c, unsigned int r) 933a66d387SMark Brown { 943a66d387SMark Brown struct i2c_msg xfer[2]; 953a66d387SMark Brown u8 reg[2]; 963a66d387SMark Brown u8 data; 973a66d387SMark Brown int ret; 983a66d387SMark Brown 993a66d387SMark Brown /* Write register */ 1003a66d387SMark Brown reg[0] = (r >> 8) & 0xff; 1013a66d387SMark Brown reg[1] = r & 0xff; 1023a66d387SMark Brown xfer[0].addr = i2c->addr; 1033a66d387SMark Brown xfer[0].flags = 0; 1043a66d387SMark Brown xfer[0].len = sizeof(reg); 1053a66d387SMark Brown xfer[0].buf = ®[0]; 1063a66d387SMark Brown 1073a66d387SMark Brown /* Read data */ 1083a66d387SMark Brown xfer[1].addr = i2c->addr; 1093a66d387SMark Brown xfer[1].flags = I2C_M_RD; 1103a66d387SMark Brown xfer[1].len = 1; 1113a66d387SMark Brown xfer[1].buf = &data; 1123a66d387SMark Brown 1133a66d387SMark Brown ret = i2c_transfer(i2c->adapter, xfer, 2); 1143a66d387SMark Brown if (ret != 2) { 1153a66d387SMark Brown dev_err(&i2c->dev, "i2c_transfer() returned %d\n", ret); 1163a66d387SMark Brown return 0; 1173a66d387SMark Brown } 1183a66d387SMark Brown 1193a66d387SMark Brown dev_vdbg(&i2c->dev, "read %x from %x\n", data, r); 1203a66d387SMark Brown 1213a66d387SMark Brown return data; 1223a66d387SMark Brown } 1233a66d387SMark Brown 1243a66d387SMark Brown static void wm2000_reset(struct wm2000_priv *wm2000) 1253a66d387SMark Brown { 1263a66d387SMark Brown struct i2c_client *i2c = wm2000->i2c; 1273a66d387SMark Brown 1283a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_ENG_CLR); 1293a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_CLR); 1303a66d387SMark Brown wm2000_write(i2c, WM2000_REG_ID1, 0); 1313a66d387SMark Brown 1323a66d387SMark Brown wm2000->anc_mode = ANC_OFF; 1333a66d387SMark Brown } 1343a66d387SMark Brown 1353a66d387SMark Brown static int wm2000_poll_bit(struct i2c_client *i2c, 1363a66d387SMark Brown unsigned int reg, u8 mask, int timeout) 1373a66d387SMark Brown { 1383a66d387SMark Brown int val; 1393a66d387SMark Brown 1403a66d387SMark Brown val = wm2000_read(i2c, reg); 1413a66d387SMark Brown 1423a66d387SMark Brown while (!(val & mask) && --timeout) { 1433a66d387SMark Brown msleep(1); 1443a66d387SMark Brown val = wm2000_read(i2c, reg); 1453a66d387SMark Brown } 1463a66d387SMark Brown 1473a66d387SMark Brown if (timeout == 0) 1483a66d387SMark Brown return 0; 1493a66d387SMark Brown else 1503a66d387SMark Brown return 1; 1513a66d387SMark Brown } 1523a66d387SMark Brown 1533a66d387SMark Brown static int wm2000_power_up(struct i2c_client *i2c, int analogue) 1543a66d387SMark Brown { 1553a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 1563a66d387SMark Brown int ret, timeout; 1573a66d387SMark Brown 1583a66d387SMark Brown BUG_ON(wm2000->anc_mode != ANC_OFF); 1593a66d387SMark Brown 1603a66d387SMark Brown dev_dbg(&i2c->dev, "Beginning power up\n"); 1613a66d387SMark Brown 1623a66d387SMark Brown if (!wm2000->mclk_div) { 1633a66d387SMark Brown dev_dbg(&i2c->dev, "Disabling MCLK divider\n"); 1643a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, 1653a66d387SMark Brown WM2000_MCLK_DIV2_ENA_CLR); 1663a66d387SMark Brown } else { 1673a66d387SMark Brown dev_dbg(&i2c->dev, "Enabling MCLK divider\n"); 1683a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, 1693a66d387SMark Brown WM2000_MCLK_DIV2_ENA_SET); 1703a66d387SMark Brown } 1713a66d387SMark Brown 1723a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_ENG_CLR); 1733a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_ENG_SET); 1743a66d387SMark Brown 1753a66d387SMark Brown /* Wait for ANC engine to become ready */ 1763a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_ANC_STAT, 1773a66d387SMark Brown WM2000_ANC_ENG_IDLE, 1)) { 1783a66d387SMark Brown dev_err(&i2c->dev, "ANC engine failed to reset\n"); 1793a66d387SMark Brown return -ETIMEDOUT; 1803a66d387SMark Brown } 1813a66d387SMark Brown 1823a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS, 1833a66d387SMark Brown WM2000_STATUS_BOOT_COMPLETE, 1)) { 1843a66d387SMark Brown dev_err(&i2c->dev, "ANC engine failed to initialise\n"); 1853a66d387SMark Brown return -ETIMEDOUT; 1863a66d387SMark Brown } 1873a66d387SMark Brown 1883a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_SET); 1893a66d387SMark Brown 1903a66d387SMark Brown /* Open code download of the data since it is the only bulk 1913a66d387SMark Brown * write we do. */ 1923a66d387SMark Brown dev_dbg(&i2c->dev, "Downloading %d bytes\n", 1933a66d387SMark Brown wm2000->anc_download_size - 2); 1943a66d387SMark Brown 1953a66d387SMark Brown ret = i2c_master_send(i2c, wm2000->anc_download, 1963a66d387SMark Brown wm2000->anc_download_size); 1973a66d387SMark Brown if (ret < 0) { 1983a66d387SMark Brown dev_err(&i2c->dev, "i2c_transfer() failed: %d\n", ret); 1993a66d387SMark Brown return ret; 2003a66d387SMark Brown } 2013a66d387SMark Brown if (ret != wm2000->anc_download_size) { 2023a66d387SMark Brown dev_err(&i2c->dev, "i2c_transfer() failed, %d != %d\n", 2033a66d387SMark Brown ret, wm2000->anc_download_size); 2043a66d387SMark Brown return -EIO; 2053a66d387SMark Brown } 2063a66d387SMark Brown 2073a66d387SMark Brown dev_dbg(&i2c->dev, "Download complete\n"); 2083a66d387SMark Brown 2093a66d387SMark Brown if (analogue) { 2103a66d387SMark Brown timeout = 248; 2113a66d387SMark Brown wm2000_write(i2c, WM2000_REG_ANA_VMID_PU_TIME, timeout / 4); 2123a66d387SMark Brown 2133a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 2143a66d387SMark Brown WM2000_MODE_ANA_SEQ_INCLUDE | 2153a66d387SMark Brown WM2000_MODE_MOUSE_ENABLE | 2163a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE); 2173a66d387SMark Brown } else { 2183a66d387SMark Brown timeout = 10; 2193a66d387SMark Brown 2203a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 2213a66d387SMark Brown WM2000_MODE_MOUSE_ENABLE | 2223a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE); 2233a66d387SMark Brown } 2243a66d387SMark Brown 2253a66d387SMark Brown ret = wm2000_read(i2c, WM2000_REG_SPEECH_CLARITY); 2263a66d387SMark Brown if (wm2000->speech_clarity) 2273a66d387SMark Brown ret &= ~WM2000_SPEECH_CLARITY; 2283a66d387SMark Brown else 2293a66d387SMark Brown ret |= WM2000_SPEECH_CLARITY; 2303a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SPEECH_CLARITY, ret); 2313a66d387SMark Brown 2323a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_START0, 0x33); 2333a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_START1, 0x02); 2343a66d387SMark Brown 2353a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_INT_N_CLR); 2363a66d387SMark Brown 2373a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS, 2383a66d387SMark Brown WM2000_STATUS_MOUSE_ACTIVE, timeout)) { 2393a66d387SMark Brown dev_err(&i2c->dev, "Timed out waiting for device after %dms\n", 2403a66d387SMark Brown timeout * 10); 2413a66d387SMark Brown return -ETIMEDOUT; 2423a66d387SMark Brown } 2433a66d387SMark Brown 2443a66d387SMark Brown dev_dbg(&i2c->dev, "ANC active\n"); 2453a66d387SMark Brown if (analogue) 2463a66d387SMark Brown dev_dbg(&i2c->dev, "Analogue active\n"); 2473a66d387SMark Brown wm2000->anc_mode = ANC_ACTIVE; 2483a66d387SMark Brown 2493a66d387SMark Brown return 0; 2503a66d387SMark Brown } 2513a66d387SMark Brown 2523a66d387SMark Brown static int wm2000_power_down(struct i2c_client *i2c, int analogue) 2533a66d387SMark Brown { 2543a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 2553a66d387SMark Brown int timeout; 2563a66d387SMark Brown 2573a66d387SMark Brown if (analogue) { 2583a66d387SMark Brown timeout = 248; 2593a66d387SMark Brown wm2000_write(i2c, WM2000_REG_ANA_VMID_PD_TIME, timeout / 4); 2603a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 2613a66d387SMark Brown WM2000_MODE_ANA_SEQ_INCLUDE | 2623a66d387SMark Brown WM2000_MODE_POWER_DOWN); 2633a66d387SMark Brown } else { 2643a66d387SMark Brown timeout = 10; 2653a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 2663a66d387SMark Brown WM2000_MODE_POWER_DOWN); 2673a66d387SMark Brown } 2683a66d387SMark Brown 2693a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS, 2703a66d387SMark Brown WM2000_STATUS_POWER_DOWN_COMPLETE, timeout)) { 2713a66d387SMark Brown dev_err(&i2c->dev, "Timeout waiting for ANC power down\n"); 2723a66d387SMark Brown return -ETIMEDOUT; 2733a66d387SMark Brown } 2743a66d387SMark Brown 2753a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_ANC_STAT, 2763a66d387SMark Brown WM2000_ANC_ENG_IDLE, 1)) { 2773a66d387SMark Brown dev_err(&i2c->dev, "Timeout waiting for ANC engine idle\n"); 2783a66d387SMark Brown return -ETIMEDOUT; 2793a66d387SMark Brown } 2803a66d387SMark Brown 2813a66d387SMark Brown dev_dbg(&i2c->dev, "powered off\n"); 2823a66d387SMark Brown wm2000->anc_mode = ANC_OFF; 2833a66d387SMark Brown 2843a66d387SMark Brown return 0; 2853a66d387SMark Brown } 2863a66d387SMark Brown 2873a66d387SMark Brown static int wm2000_enter_bypass(struct i2c_client *i2c, int analogue) 2883a66d387SMark Brown { 2893a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 2903a66d387SMark Brown 2913a66d387SMark Brown BUG_ON(wm2000->anc_mode != ANC_ACTIVE); 2923a66d387SMark Brown 2933a66d387SMark Brown if (analogue) { 2943a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 2953a66d387SMark Brown WM2000_MODE_ANA_SEQ_INCLUDE | 2963a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE | 2973a66d387SMark Brown WM2000_MODE_BYPASS_ENTRY); 2983a66d387SMark Brown } else { 2993a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 3003a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE | 3013a66d387SMark Brown WM2000_MODE_BYPASS_ENTRY); 3023a66d387SMark Brown } 3033a66d387SMark Brown 3043a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS, 3053a66d387SMark Brown WM2000_STATUS_ANC_DISABLED, 10)) { 3063a66d387SMark Brown dev_err(&i2c->dev, "Timeout waiting for ANC disable\n"); 3073a66d387SMark Brown return -ETIMEDOUT; 3083a66d387SMark Brown } 3093a66d387SMark Brown 3103a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_ANC_STAT, 3113a66d387SMark Brown WM2000_ANC_ENG_IDLE, 1)) { 3123a66d387SMark Brown dev_err(&i2c->dev, "Timeout waiting for ANC engine idle\n"); 3133a66d387SMark Brown return -ETIMEDOUT; 3143a66d387SMark Brown } 3153a66d387SMark Brown 3163a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL1, WM2000_SYS_STBY); 3173a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_CLR); 3183a66d387SMark Brown 3193a66d387SMark Brown wm2000->anc_mode = ANC_BYPASS; 3203a66d387SMark Brown dev_dbg(&i2c->dev, "bypass enabled\n"); 3213a66d387SMark Brown 3223a66d387SMark Brown return 0; 3233a66d387SMark Brown } 3243a66d387SMark Brown 3253a66d387SMark Brown static int wm2000_exit_bypass(struct i2c_client *i2c, int analogue) 3263a66d387SMark Brown { 3273a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 3283a66d387SMark Brown 3293a66d387SMark Brown BUG_ON(wm2000->anc_mode != ANC_BYPASS); 3303a66d387SMark Brown 3313a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL1, 0); 3323a66d387SMark Brown 3333a66d387SMark Brown if (analogue) { 3343a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 3353a66d387SMark Brown WM2000_MODE_ANA_SEQ_INCLUDE | 3363a66d387SMark Brown WM2000_MODE_MOUSE_ENABLE | 3373a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE); 3383a66d387SMark Brown } else { 3393a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 3403a66d387SMark Brown WM2000_MODE_MOUSE_ENABLE | 3413a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE); 3423a66d387SMark Brown } 3433a66d387SMark Brown 3443a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_SET); 3453a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_INT_N_CLR); 3463a66d387SMark Brown 3473a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS, 3483a66d387SMark Brown WM2000_STATUS_MOUSE_ACTIVE, 10)) { 3493a66d387SMark Brown dev_err(&i2c->dev, "Timed out waiting for MOUSE\n"); 3503a66d387SMark Brown return -ETIMEDOUT; 3513a66d387SMark Brown } 3523a66d387SMark Brown 3533a66d387SMark Brown wm2000->anc_mode = ANC_ACTIVE; 3543a66d387SMark Brown dev_dbg(&i2c->dev, "MOUSE active\n"); 3553a66d387SMark Brown 3563a66d387SMark Brown return 0; 3573a66d387SMark Brown } 3583a66d387SMark Brown 3593a66d387SMark Brown static int wm2000_enter_standby(struct i2c_client *i2c, int analogue) 3603a66d387SMark Brown { 3613a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 3623a66d387SMark Brown int timeout; 3633a66d387SMark Brown 3643a66d387SMark Brown BUG_ON(wm2000->anc_mode != ANC_ACTIVE); 3653a66d387SMark Brown 3663a66d387SMark Brown if (analogue) { 3673a66d387SMark Brown timeout = 248; 3683a66d387SMark Brown wm2000_write(i2c, WM2000_REG_ANA_VMID_PD_TIME, timeout / 4); 3693a66d387SMark Brown 3703a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 3713a66d387SMark Brown WM2000_MODE_ANA_SEQ_INCLUDE | 3723a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE | 3733a66d387SMark Brown WM2000_MODE_STANDBY_ENTRY); 3743a66d387SMark Brown } else { 3753a66d387SMark Brown timeout = 10; 3763a66d387SMark Brown 3773a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 3783a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE | 3793a66d387SMark Brown WM2000_MODE_STANDBY_ENTRY); 3803a66d387SMark Brown } 3813a66d387SMark Brown 3823a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS, 3833a66d387SMark Brown WM2000_STATUS_ANC_DISABLED, timeout)) { 3843a66d387SMark Brown dev_err(&i2c->dev, 3853a66d387SMark Brown "Timed out waiting for ANC disable after 1ms\n"); 3863a66d387SMark Brown return -ETIMEDOUT; 3873a66d387SMark Brown } 3883a66d387SMark Brown 3893a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_ANC_STAT, WM2000_ANC_ENG_IDLE, 3903a66d387SMark Brown 1)) { 3913a66d387SMark Brown dev_err(&i2c->dev, 3923a66d387SMark Brown "Timed out waiting for standby after %dms\n", 3933a66d387SMark Brown timeout * 10); 3943a66d387SMark Brown return -ETIMEDOUT; 3953a66d387SMark Brown } 3963a66d387SMark Brown 3973a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL1, WM2000_SYS_STBY); 3983a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_CLR); 3993a66d387SMark Brown 4003a66d387SMark Brown wm2000->anc_mode = ANC_STANDBY; 4013a66d387SMark Brown dev_dbg(&i2c->dev, "standby\n"); 4023a66d387SMark Brown if (analogue) 4033a66d387SMark Brown dev_dbg(&i2c->dev, "Analogue disabled\n"); 4043a66d387SMark Brown 4053a66d387SMark Brown return 0; 4063a66d387SMark Brown } 4073a66d387SMark Brown 4083a66d387SMark Brown static int wm2000_exit_standby(struct i2c_client *i2c, int analogue) 4093a66d387SMark Brown { 4103a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 4113a66d387SMark Brown int timeout; 4123a66d387SMark Brown 4133a66d387SMark Brown BUG_ON(wm2000->anc_mode != ANC_STANDBY); 4143a66d387SMark Brown 4153a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL1, 0); 4163a66d387SMark Brown 4173a66d387SMark Brown if (analogue) { 4183a66d387SMark Brown timeout = 248; 4193a66d387SMark Brown wm2000_write(i2c, WM2000_REG_ANA_VMID_PU_TIME, timeout / 4); 4203a66d387SMark Brown 4213a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 4223a66d387SMark Brown WM2000_MODE_ANA_SEQ_INCLUDE | 4233a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE | 4243a66d387SMark Brown WM2000_MODE_MOUSE_ENABLE); 4253a66d387SMark Brown } else { 4263a66d387SMark Brown timeout = 10; 4273a66d387SMark Brown 4283a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_MODE_CNTRL, 4293a66d387SMark Brown WM2000_MODE_THERMAL_ENABLE | 4303a66d387SMark Brown WM2000_MODE_MOUSE_ENABLE); 4313a66d387SMark Brown } 4323a66d387SMark Brown 4333a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_RAM_SET); 4343a66d387SMark Brown wm2000_write(i2c, WM2000_REG_SYS_CTL2, WM2000_ANC_INT_N_CLR); 4353a66d387SMark Brown 4363a66d387SMark Brown if (!wm2000_poll_bit(i2c, WM2000_REG_SYS_STATUS, 4373a66d387SMark Brown WM2000_STATUS_MOUSE_ACTIVE, timeout)) { 4383a66d387SMark Brown dev_err(&i2c->dev, "Timed out waiting for MOUSE after %dms\n", 4393a66d387SMark Brown timeout * 10); 4403a66d387SMark Brown return -ETIMEDOUT; 4413a66d387SMark Brown } 4423a66d387SMark Brown 4433a66d387SMark Brown wm2000->anc_mode = ANC_ACTIVE; 4443a66d387SMark Brown dev_dbg(&i2c->dev, "MOUSE active\n"); 4453a66d387SMark Brown if (analogue) 4463a66d387SMark Brown dev_dbg(&i2c->dev, "Analogue enabled\n"); 4473a66d387SMark Brown 4483a66d387SMark Brown return 0; 4493a66d387SMark Brown } 4503a66d387SMark Brown 4513a66d387SMark Brown typedef int (*wm2000_mode_fn)(struct i2c_client *i2c, int analogue); 4523a66d387SMark Brown 4533a66d387SMark Brown static struct { 4543a66d387SMark Brown enum wm2000_anc_mode source; 4553a66d387SMark Brown enum wm2000_anc_mode dest; 4563a66d387SMark Brown int analogue; 4573a66d387SMark Brown wm2000_mode_fn step[2]; 4583a66d387SMark Brown } anc_transitions[] = { 4593a66d387SMark Brown { 4603a66d387SMark Brown .source = ANC_OFF, 4613a66d387SMark Brown .dest = ANC_ACTIVE, 4623a66d387SMark Brown .analogue = 1, 4633a66d387SMark Brown .step = { 4643a66d387SMark Brown wm2000_power_up, 4653a66d387SMark Brown }, 4663a66d387SMark Brown }, 4673a66d387SMark Brown { 4683a66d387SMark Brown .source = ANC_OFF, 4693a66d387SMark Brown .dest = ANC_STANDBY, 4703a66d387SMark Brown .step = { 4713a66d387SMark Brown wm2000_power_up, 4723a66d387SMark Brown wm2000_enter_standby, 4733a66d387SMark Brown }, 4743a66d387SMark Brown }, 4753a66d387SMark Brown { 4763a66d387SMark Brown .source = ANC_OFF, 4773a66d387SMark Brown .dest = ANC_BYPASS, 4783a66d387SMark Brown .analogue = 1, 4793a66d387SMark Brown .step = { 4803a66d387SMark Brown wm2000_power_up, 4813a66d387SMark Brown wm2000_enter_bypass, 4823a66d387SMark Brown }, 4833a66d387SMark Brown }, 4843a66d387SMark Brown { 4853a66d387SMark Brown .source = ANC_ACTIVE, 4863a66d387SMark Brown .dest = ANC_BYPASS, 4873a66d387SMark Brown .analogue = 1, 4883a66d387SMark Brown .step = { 4893a66d387SMark Brown wm2000_enter_bypass, 4903a66d387SMark Brown }, 4913a66d387SMark Brown }, 4923a66d387SMark Brown { 4933a66d387SMark Brown .source = ANC_ACTIVE, 4943a66d387SMark Brown .dest = ANC_STANDBY, 4953a66d387SMark Brown .analogue = 1, 4963a66d387SMark Brown .step = { 4973a66d387SMark Brown wm2000_enter_standby, 4983a66d387SMark Brown }, 4993a66d387SMark Brown }, 5003a66d387SMark Brown { 5013a66d387SMark Brown .source = ANC_ACTIVE, 5023a66d387SMark Brown .dest = ANC_OFF, 5033a66d387SMark Brown .analogue = 1, 5043a66d387SMark Brown .step = { 5053a66d387SMark Brown wm2000_power_down, 5063a66d387SMark Brown }, 5073a66d387SMark Brown }, 5083a66d387SMark Brown { 5093a66d387SMark Brown .source = ANC_BYPASS, 5103a66d387SMark Brown .dest = ANC_ACTIVE, 5113a66d387SMark Brown .analogue = 1, 5123a66d387SMark Brown .step = { 5133a66d387SMark Brown wm2000_exit_bypass, 5143a66d387SMark Brown }, 5153a66d387SMark Brown }, 5163a66d387SMark Brown { 5173a66d387SMark Brown .source = ANC_BYPASS, 5183a66d387SMark Brown .dest = ANC_STANDBY, 5193a66d387SMark Brown .analogue = 1, 5203a66d387SMark Brown .step = { 5213a66d387SMark Brown wm2000_exit_bypass, 5223a66d387SMark Brown wm2000_enter_standby, 5233a66d387SMark Brown }, 5243a66d387SMark Brown }, 5253a66d387SMark Brown { 5263a66d387SMark Brown .source = ANC_BYPASS, 5273a66d387SMark Brown .dest = ANC_OFF, 5283a66d387SMark Brown .step = { 5293a66d387SMark Brown wm2000_exit_bypass, 5303a66d387SMark Brown wm2000_power_down, 5313a66d387SMark Brown }, 5323a66d387SMark Brown }, 5333a66d387SMark Brown { 5343a66d387SMark Brown .source = ANC_STANDBY, 5353a66d387SMark Brown .dest = ANC_ACTIVE, 5363a66d387SMark Brown .analogue = 1, 5373a66d387SMark Brown .step = { 5383a66d387SMark Brown wm2000_exit_standby, 5393a66d387SMark Brown }, 5403a66d387SMark Brown }, 5413a66d387SMark Brown { 5423a66d387SMark Brown .source = ANC_STANDBY, 5433a66d387SMark Brown .dest = ANC_BYPASS, 5443a66d387SMark Brown .analogue = 1, 5453a66d387SMark Brown .step = { 5463a66d387SMark Brown wm2000_exit_standby, 5473a66d387SMark Brown wm2000_enter_bypass, 5483a66d387SMark Brown }, 5493a66d387SMark Brown }, 5503a66d387SMark Brown { 5513a66d387SMark Brown .source = ANC_STANDBY, 5523a66d387SMark Brown .dest = ANC_OFF, 5533a66d387SMark Brown .step = { 5543a66d387SMark Brown wm2000_exit_standby, 5553a66d387SMark Brown wm2000_power_down, 5563a66d387SMark Brown }, 5573a66d387SMark Brown }, 5583a66d387SMark Brown }; 5593a66d387SMark Brown 5603a66d387SMark Brown static int wm2000_anc_transition(struct wm2000_priv *wm2000, 5613a66d387SMark Brown enum wm2000_anc_mode mode) 5623a66d387SMark Brown { 5633a66d387SMark Brown struct i2c_client *i2c = wm2000->i2c; 5643a66d387SMark Brown int i, j; 5653a66d387SMark Brown int ret; 5663a66d387SMark Brown 5673a66d387SMark Brown if (wm2000->anc_mode == mode) 5683a66d387SMark Brown return 0; 5693a66d387SMark Brown 5703a66d387SMark Brown for (i = 0; i < ARRAY_SIZE(anc_transitions); i++) 5713a66d387SMark Brown if (anc_transitions[i].source == wm2000->anc_mode && 5723a66d387SMark Brown anc_transitions[i].dest == mode) 5733a66d387SMark Brown break; 5743a66d387SMark Brown if (i == ARRAY_SIZE(anc_transitions)) { 5753a66d387SMark Brown dev_err(&i2c->dev, "No transition for %d->%d\n", 5763a66d387SMark Brown wm2000->anc_mode, mode); 5773a66d387SMark Brown return -EINVAL; 5783a66d387SMark Brown } 5793a66d387SMark Brown 5803a66d387SMark Brown for (j = 0; j < ARRAY_SIZE(anc_transitions[j].step); j++) { 5813a66d387SMark Brown if (!anc_transitions[i].step[j]) 5823a66d387SMark Brown break; 5833a66d387SMark Brown ret = anc_transitions[i].step[j](i2c, 5843a66d387SMark Brown anc_transitions[i].analogue); 5853a66d387SMark Brown if (ret != 0) 5863a66d387SMark Brown return ret; 5873a66d387SMark Brown } 5883a66d387SMark Brown 5893a66d387SMark Brown return 0; 5903a66d387SMark Brown } 5913a66d387SMark Brown 5923a66d387SMark Brown static int wm2000_anc_set_mode(struct wm2000_priv *wm2000) 5933a66d387SMark Brown { 5943a66d387SMark Brown struct i2c_client *i2c = wm2000->i2c; 5953a66d387SMark Brown enum wm2000_anc_mode mode; 5963a66d387SMark Brown 5973a66d387SMark Brown if (wm2000->anc_eng_ena && wm2000->spk_ena) 5983a66d387SMark Brown if (wm2000->anc_active) 5993a66d387SMark Brown mode = ANC_ACTIVE; 6003a66d387SMark Brown else 6013a66d387SMark Brown mode = ANC_BYPASS; 6023a66d387SMark Brown else 6033a66d387SMark Brown mode = ANC_STANDBY; 6043a66d387SMark Brown 6053a66d387SMark Brown dev_dbg(&i2c->dev, "Set mode %d (enabled %d, mute %d, active %d)\n", 6063a66d387SMark Brown mode, wm2000->anc_eng_ena, !wm2000->spk_ena, 6073a66d387SMark Brown wm2000->anc_active); 6083a66d387SMark Brown 6093a66d387SMark Brown return wm2000_anc_transition(wm2000, mode); 6103a66d387SMark Brown } 6113a66d387SMark Brown 6123a66d387SMark Brown static int wm2000_anc_mode_get(struct snd_kcontrol *kcontrol, 6133a66d387SMark Brown struct snd_ctl_elem_value *ucontrol) 6143a66d387SMark Brown { 6153a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&wm2000_i2c->dev); 6163a66d387SMark Brown 6173a66d387SMark Brown ucontrol->value.enumerated.item[0] = wm2000->anc_active; 6183a66d387SMark Brown 6193a66d387SMark Brown return 0; 6203a66d387SMark Brown } 6213a66d387SMark Brown 6223a66d387SMark Brown static int wm2000_anc_mode_put(struct snd_kcontrol *kcontrol, 6233a66d387SMark Brown struct snd_ctl_elem_value *ucontrol) 6243a66d387SMark Brown { 6253a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&wm2000_i2c->dev); 6263a66d387SMark Brown int anc_active = ucontrol->value.enumerated.item[0]; 6273a66d387SMark Brown 6283a66d387SMark Brown if (anc_active > 1) 6293a66d387SMark Brown return -EINVAL; 6303a66d387SMark Brown 6313a66d387SMark Brown wm2000->anc_active = anc_active; 6323a66d387SMark Brown 6333a66d387SMark Brown return wm2000_anc_set_mode(wm2000); 6343a66d387SMark Brown } 6353a66d387SMark Brown 6363a66d387SMark Brown static int wm2000_speaker_get(struct snd_kcontrol *kcontrol, 6373a66d387SMark Brown struct snd_ctl_elem_value *ucontrol) 6383a66d387SMark Brown { 6393a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&wm2000_i2c->dev); 6403a66d387SMark Brown 6413a66d387SMark Brown ucontrol->value.enumerated.item[0] = wm2000->spk_ena; 6423a66d387SMark Brown 6433a66d387SMark Brown return 0; 6443a66d387SMark Brown } 6453a66d387SMark Brown 6463a66d387SMark Brown static int wm2000_speaker_put(struct snd_kcontrol *kcontrol, 6473a66d387SMark Brown struct snd_ctl_elem_value *ucontrol) 6483a66d387SMark Brown { 6493a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&wm2000_i2c->dev); 6503a66d387SMark Brown int val = ucontrol->value.enumerated.item[0]; 6513a66d387SMark Brown 6523a66d387SMark Brown if (val > 1) 6533a66d387SMark Brown return -EINVAL; 6543a66d387SMark Brown 6553a66d387SMark Brown wm2000->spk_ena = val; 6563a66d387SMark Brown 6573a66d387SMark Brown return wm2000_anc_set_mode(wm2000); 6583a66d387SMark Brown } 6593a66d387SMark Brown 6603a66d387SMark Brown static const struct snd_kcontrol_new wm2000_controls[] = { 6613a66d387SMark Brown SOC_SINGLE_BOOL_EXT("WM2000 ANC Switch", 0, 6623a66d387SMark Brown wm2000_anc_mode_get, 6633a66d387SMark Brown wm2000_anc_mode_put), 6643a66d387SMark Brown SOC_SINGLE_BOOL_EXT("WM2000 Switch", 0, 6653a66d387SMark Brown wm2000_speaker_get, 6663a66d387SMark Brown wm2000_speaker_put), 6673a66d387SMark Brown }; 6683a66d387SMark Brown 6693a66d387SMark Brown static int wm2000_anc_power_event(struct snd_soc_dapm_widget *w, 6703a66d387SMark Brown struct snd_kcontrol *kcontrol, int event) 6713a66d387SMark Brown { 6723a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&wm2000_i2c->dev); 6733a66d387SMark Brown 6743a66d387SMark Brown if (SND_SOC_DAPM_EVENT_ON(event)) 6753a66d387SMark Brown wm2000->anc_eng_ena = 1; 6763a66d387SMark Brown 6773a66d387SMark Brown if (SND_SOC_DAPM_EVENT_OFF(event)) 6783a66d387SMark Brown wm2000->anc_eng_ena = 0; 6793a66d387SMark Brown 6803a66d387SMark Brown return wm2000_anc_set_mode(wm2000); 6813a66d387SMark Brown } 6823a66d387SMark Brown 6833a66d387SMark Brown static const struct snd_soc_dapm_widget wm2000_dapm_widgets[] = { 6843a66d387SMark Brown /* Externally visible pins */ 6853a66d387SMark Brown SND_SOC_DAPM_OUTPUT("WM2000 SPKN"), 6863a66d387SMark Brown SND_SOC_DAPM_OUTPUT("WM2000 SPKP"), 6873a66d387SMark Brown 6883a66d387SMark Brown SND_SOC_DAPM_INPUT("WM2000 LINN"), 6893a66d387SMark Brown SND_SOC_DAPM_INPUT("WM2000 LINP"), 6903a66d387SMark Brown 6913a66d387SMark Brown SND_SOC_DAPM_PGA_E("ANC Engine", SND_SOC_NOPM, 0, 0, NULL, 0, 6923a66d387SMark Brown wm2000_anc_power_event, 6933a66d387SMark Brown SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD), 6943a66d387SMark Brown }; 6953a66d387SMark Brown 6963a66d387SMark Brown /* Target, Path, Source */ 6973a66d387SMark Brown static const struct snd_soc_dapm_route audio_map[] = { 6983a66d387SMark Brown { "WM2000 SPKN", NULL, "ANC Engine" }, 6993a66d387SMark Brown { "WM2000 SPKP", NULL, "ANC Engine" }, 7003a66d387SMark Brown { "ANC Engine", NULL, "WM2000 LINN" }, 7013a66d387SMark Brown { "ANC Engine", NULL, "WM2000 LINP" }, 7023a66d387SMark Brown }; 7033a66d387SMark Brown 7043a66d387SMark Brown /* Called from the machine driver */ 7053a66d387SMark Brown int wm2000_add_controls(struct snd_soc_codec *codec) 7063a66d387SMark Brown { 707ce6120ccSLiam Girdwood struct snd_soc_dapm_context *dapm = &codec->dapm; 7083a66d387SMark Brown int ret; 7093a66d387SMark Brown 7103a66d387SMark Brown if (!wm2000_i2c) { 7113a66d387SMark Brown pr_err("WM2000 not yet probed\n"); 7123a66d387SMark Brown return -ENODEV; 7133a66d387SMark Brown } 7143a66d387SMark Brown 715ce6120ccSLiam Girdwood ret = snd_soc_dapm_new_controls(dapm, wm2000_dapm_widgets, 7163a66d387SMark Brown ARRAY_SIZE(wm2000_dapm_widgets)); 7173a66d387SMark Brown if (ret < 0) 7183a66d387SMark Brown return ret; 7193a66d387SMark Brown 720ce6120ccSLiam Girdwood ret = snd_soc_dapm_add_routes(dapm, audio_map, ARRAY_SIZE(audio_map)); 7213a66d387SMark Brown if (ret < 0) 7223a66d387SMark Brown return ret; 7233a66d387SMark Brown 7243a66d387SMark Brown return snd_soc_add_controls(codec, wm2000_controls, 7253a66d387SMark Brown ARRAY_SIZE(wm2000_controls)); 7263a66d387SMark Brown } 7273a66d387SMark Brown EXPORT_SYMBOL_GPL(wm2000_add_controls); 7283a66d387SMark Brown 7293a66d387SMark Brown static int __devinit wm2000_i2c_probe(struct i2c_client *i2c, 7303a66d387SMark Brown const struct i2c_device_id *i2c_id) 7313a66d387SMark Brown { 7323a66d387SMark Brown struct wm2000_priv *wm2000; 7333a66d387SMark Brown struct wm2000_platform_data *pdata; 7343a66d387SMark Brown const char *filename; 7353a66d387SMark Brown const struct firmware *fw; 7363a66d387SMark Brown int reg, ret; 7373a66d387SMark Brown u16 id; 7383a66d387SMark Brown 7393a66d387SMark Brown if (wm2000_i2c) { 7403a66d387SMark Brown dev_err(&i2c->dev, "Another WM2000 is already registered\n"); 7413a66d387SMark Brown return -EINVAL; 7423a66d387SMark Brown } 7433a66d387SMark Brown 7443a66d387SMark Brown wm2000 = kzalloc(sizeof(struct wm2000_priv), GFP_KERNEL); 7453a66d387SMark Brown if (wm2000 == NULL) { 7463a66d387SMark Brown dev_err(&i2c->dev, "Unable to allocate private data\n"); 7473a66d387SMark Brown return -ENOMEM; 7483a66d387SMark Brown } 7493a66d387SMark Brown 7503a66d387SMark Brown /* Verify that this is a WM2000 */ 7513a66d387SMark Brown reg = wm2000_read(i2c, WM2000_REG_ID1); 7523a66d387SMark Brown id = reg << 8; 7533a66d387SMark Brown reg = wm2000_read(i2c, WM2000_REG_ID2); 7543a66d387SMark Brown id |= reg & 0xff; 7553a66d387SMark Brown 7563a66d387SMark Brown if (id != 0x2000) { 7573a66d387SMark Brown dev_err(&i2c->dev, "Device is not a WM2000 - ID %x\n", id); 7583a66d387SMark Brown ret = -ENODEV; 7593a66d387SMark Brown goto err; 7603a66d387SMark Brown } 7613a66d387SMark Brown 7623a66d387SMark Brown reg = wm2000_read(i2c, WM2000_REG_REVISON); 7633a66d387SMark Brown dev_info(&i2c->dev, "revision %c\n", reg + 'A'); 7643a66d387SMark Brown 7653a66d387SMark Brown filename = "wm2000_anc.bin"; 7663a66d387SMark Brown pdata = dev_get_platdata(&i2c->dev); 7673a66d387SMark Brown if (pdata) { 7683a66d387SMark Brown wm2000->mclk_div = pdata->mclkdiv2; 7693a66d387SMark Brown wm2000->speech_clarity = !pdata->speech_enh_disable; 7703a66d387SMark Brown 7713a66d387SMark Brown if (pdata->download_file) 7723a66d387SMark Brown filename = pdata->download_file; 7733a66d387SMark Brown } 7743a66d387SMark Brown 7753a66d387SMark Brown ret = request_firmware(&fw, filename, &i2c->dev); 7763a66d387SMark Brown if (ret != 0) { 7773a66d387SMark Brown dev_err(&i2c->dev, "Failed to acquire ANC data: %d\n", ret); 7783a66d387SMark Brown goto err; 7793a66d387SMark Brown } 7803a66d387SMark Brown 7813a66d387SMark Brown /* Pre-cook the concatenation of the register address onto the image */ 7823a66d387SMark Brown wm2000->anc_download_size = fw->size + 2; 7833a66d387SMark Brown wm2000->anc_download = kmalloc(wm2000->anc_download_size, GFP_KERNEL); 7843a66d387SMark Brown if (wm2000->anc_download == NULL) { 7853a66d387SMark Brown dev_err(&i2c->dev, "Out of memory\n"); 7863a66d387SMark Brown ret = -ENOMEM; 7873a66d387SMark Brown goto err_fw; 7883a66d387SMark Brown } 7893a66d387SMark Brown 7903a66d387SMark Brown wm2000->anc_download[0] = 0x80; 7913a66d387SMark Brown wm2000->anc_download[1] = 0x00; 7923a66d387SMark Brown memcpy(wm2000->anc_download + 2, fw->data, fw->size); 7933a66d387SMark Brown 7943a66d387SMark Brown release_firmware(fw); 7953a66d387SMark Brown 7963a66d387SMark Brown dev_set_drvdata(&i2c->dev, wm2000); 7973a66d387SMark Brown wm2000->anc_eng_ena = 1; 798e71fa370SMark Brown wm2000->anc_active = 1; 799e71fa370SMark Brown wm2000->spk_ena = 1; 8003a66d387SMark Brown wm2000->i2c = i2c; 8013a66d387SMark Brown 8023a66d387SMark Brown wm2000_reset(wm2000); 8033a66d387SMark Brown 8043a66d387SMark Brown /* This will trigger a transition to standby mode by default */ 8053a66d387SMark Brown wm2000_anc_set_mode(wm2000); 8063a66d387SMark Brown 8073a66d387SMark Brown wm2000_i2c = i2c; 8083a66d387SMark Brown 8093a66d387SMark Brown return 0; 8103a66d387SMark Brown 8113a66d387SMark Brown err_fw: 8123a66d387SMark Brown release_firmware(fw); 8133a66d387SMark Brown err: 8143a66d387SMark Brown kfree(wm2000); 8153a66d387SMark Brown return ret; 8163a66d387SMark Brown } 8173a66d387SMark Brown 8183a66d387SMark Brown static __devexit int wm2000_i2c_remove(struct i2c_client *i2c) 8193a66d387SMark Brown { 8203a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 8213a66d387SMark Brown 8223a66d387SMark Brown wm2000_anc_transition(wm2000, ANC_OFF); 8233a66d387SMark Brown 8243a66d387SMark Brown wm2000_i2c = NULL; 8253a66d387SMark Brown kfree(wm2000->anc_download); 8263a66d387SMark Brown kfree(wm2000); 8273a66d387SMark Brown 8283a66d387SMark Brown return 0; 8293a66d387SMark Brown } 8303a66d387SMark Brown 8313a66d387SMark Brown static void wm2000_i2c_shutdown(struct i2c_client *i2c) 8323a66d387SMark Brown { 8333a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 8343a66d387SMark Brown 8353a66d387SMark Brown wm2000_anc_transition(wm2000, ANC_OFF); 8363a66d387SMark Brown } 8373a66d387SMark Brown 8383a66d387SMark Brown #ifdef CONFIG_PM 839b3111a9aSMark Brown static int wm2000_i2c_suspend(struct device *dev) 8403a66d387SMark Brown { 841b3111a9aSMark Brown struct i2c_client *i2c = to_i2c_client(dev); 8423a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 8433a66d387SMark Brown 8443a66d387SMark Brown return wm2000_anc_transition(wm2000, ANC_OFF); 8453a66d387SMark Brown } 8463a66d387SMark Brown 847b3111a9aSMark Brown static int wm2000_i2c_resume(struct device *dev) 8483a66d387SMark Brown { 849b3111a9aSMark Brown struct i2c_client *i2c = to_i2c_client(dev); 8503a66d387SMark Brown struct wm2000_priv *wm2000 = dev_get_drvdata(&i2c->dev); 8513a66d387SMark Brown 8523a66d387SMark Brown return wm2000_anc_set_mode(wm2000); 8533a66d387SMark Brown } 8543a66d387SMark Brown #endif 8553a66d387SMark Brown 856b3111a9aSMark Brown static SIMPLE_DEV_PM_OPS(wm2000_pm, wm2000_i2c_suspend, wm2000_i2c_resume); 857b3111a9aSMark Brown 8583a66d387SMark Brown static const struct i2c_device_id wm2000_i2c_id[] = { 8593a66d387SMark Brown { "wm2000", 0 }, 8603a66d387SMark Brown { } 8613a66d387SMark Brown }; 8623a66d387SMark Brown MODULE_DEVICE_TABLE(i2c, wm2000_i2c_id); 8633a66d387SMark Brown 8643a66d387SMark Brown static struct i2c_driver wm2000_i2c_driver = { 8653a66d387SMark Brown .driver = { 8663a66d387SMark Brown .name = "wm2000", 8673a66d387SMark Brown .owner = THIS_MODULE, 868b3111a9aSMark Brown .pm = &wm2000_pm, 8693a66d387SMark Brown }, 8703a66d387SMark Brown .probe = wm2000_i2c_probe, 8713a66d387SMark Brown .remove = __devexit_p(wm2000_i2c_remove), 8723a66d387SMark Brown .shutdown = wm2000_i2c_shutdown, 8733a66d387SMark Brown .id_table = wm2000_i2c_id, 8743a66d387SMark Brown }; 8753a66d387SMark Brown 8763a66d387SMark Brown static int __init wm2000_init(void) 8773a66d387SMark Brown { 8783a66d387SMark Brown return i2c_add_driver(&wm2000_i2c_driver); 8793a66d387SMark Brown } 8803a66d387SMark Brown module_init(wm2000_init); 8813a66d387SMark Brown 8823a66d387SMark Brown static void __exit wm2000_exit(void) 8833a66d387SMark Brown { 8843a66d387SMark Brown i2c_del_driver(&wm2000_i2c_driver); 8853a66d387SMark Brown } 8863a66d387SMark Brown module_exit(wm2000_exit); 8873a66d387SMark Brown 8883a66d387SMark Brown MODULE_DESCRIPTION("ASoC WM2000 driver"); 8893a66d387SMark Brown MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfonmicro.com>"); 8903a66d387SMark Brown MODULE_LICENSE("GPL"); 891