Add codec wm8994
authorroot <root@yes-desktop.(none)>
Wed, 14 Jul 2010 02:52:16 +0000 (10:52 +0800)
committerroot <root@yes-desktop.(none)>
Wed, 14 Jul 2010 02:52:16 +0000 (10:52 +0800)
arch/arm/mach-rk2818/board-midsdk.c
drivers/power/Kconfig
drivers/power/Makefile
drivers/power/pmic_lp8725.c [new file with mode: 0644]
sound/soc/codecs/Kconfig
sound/soc/codecs/Makefile
sound/soc/codecs/wm8994.c [new file with mode: 0755]
sound/soc/codecs/wm8994.h [new file with mode: 0644]
sound/soc/rk2818/Kconfig
sound/soc/rk2818/rk2818_wm8994.c [new file with mode: 0755]

index aad050d66561e4418ddce4d25110b8611bd211be..33c16a855ef5f94f33b949d1484fff1200c71afb 100644 (file)
@@ -341,7 +341,21 @@ static struct i2c_board_info __initdata board_i2c1_devices[] = {
                .platform_data=&rk2818_pca9554_data.gpio_base,
        },
 #endif
-       {}
+#if defined (CONFIG_SND_SOC_WM8994)
+       {
+               .type                   = "wm8994",
+               .addr           = 0x1a,
+               .flags                  = 0,
+       },
+#endif
+#if defined (CONFIG_PMIC_LP8725)
+       {
+               .type                   = "lp8725",
+               .addr           = 0x79, 
+               .flags                  = 0,
+       },
+#endif
+       {},
 };
 
 
index f909f2f8f9fc575a15f9d1ec298a3590249a28b7..b5d5f6274030b0599534ca49ed59c05426a172fc 100644 (file)
@@ -115,4 +115,10 @@ config BATTERY_RK2818
        depends on RK28_ADC
        help
          Say Y to enable support for the battery on the RK2818.
+         
+config PMIC_LP8725
+tristate "pmic lp8725"
+depends on I2C
+help
+  Say Y to enable support for the pmic lp8725 on the RK2818.  
 endif # POWER_SUPPLY
index 10caf2200b8501bee35ecf5565c0c789a3084371..3be2b815dfb761940ead2351afcae4db97f0fce6 100644 (file)
@@ -30,3 +30,4 @@ obj-$(CONFIG_BATTERY_DA9030)  += da9030_battery.o
 obj-$(CONFIG_BATTERY_MAX17040) += max17040_battery.o
 obj-$(CONFIG_CHARGER_PCF50633) += pcf50633-charger.o
 obj-$(CONFIG_BATTERY_RK2818)   += rk2818_battery.o
+obj-$(CONFIG_PMIC_LP8725)      += pmic_lp8725.o
diff --git a/drivers/power/pmic_lp8725.c b/drivers/power/pmic_lp8725.c
new file mode 100644 (file)
index 0000000..8ca1dbc
--- /dev/null
@@ -0,0 +1,780 @@
+/* arch/arm/mach-rk2818/example.c
+ *
+ * Copyright (C) 2010 ROCKCHIP, Inc.
+ *
+ * This software is licensed under the terms of the GNU General Public
+ * License version 2, as published by the Free Software Foundation, and
+ * may be copied, distributed, and modified under those terms.
+ *
+ * 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.
+ *
+ */
+/*******************************************************************/
+/*       COPYRIGHT (C)  ROCK-CHIPS FUZHOU . ALL RIGHTS RESERVED.                         */
+/*******************************************************************
+FILE           :         PCA9554.C
+DESC           :         À©Õ¹GPIO µÄÇý¶¯Ïà¹Ø³ÌÐò
+AUTHOR         :         ZHONGYW  
+DATE           :         2009-4-26
+NOTES          :
+$LOG: GPIO.C,V $
+REVISION 0.01
+********************************************************************/
+#include <linux/clk.h>
+#include <linux/errno.h>
+#include <linux/interrupt.h>
+#include <asm/mach-types.h>
+#include <linux/irq.h>
+#include <linux/debugfs.h>
+#include <linux/seq_file.h>
+#include <linux/kernel.h>
+#include <linux/list.h>
+#include <linux/module.h>
+#include <linux/io.h>
+#include <mach/hardware.h>
+#include <mach/gpio.h>
+#include <mach/rk2818_iomap.h>
+#include <mach/iomux.h>
+#include <linux/device.h>
+#include <mach/gpio.h>
+#include <asm/gpio.h>
+#include <linux/i2c.h>
+#include <linux/workqueue.h>
+#include <mach/board.h>
+#include <linux/delay.h>
+
+
+#if 1
+#define DBG(x...)      printk(KERN_INFO x)
+#else
+#define DBG(x...)
+#endif
+
+#if 1
+#define DBGERR(x...)   printk(KERN_INFO x)
+#else
+#define DBGERR(x...)
+#endif
+
+#define DEFSEL_VIN1
+
+#define GENERAL_REG_ADDR 0x0
+#define LDO1_REG_ADDR 0x01
+#define LDO2_REG_ADDR 0x02
+#define LDO3_REG_ADDR 0x03
+#define LDO4_REG_ADDR 0x04
+#define LDO5_REG_ADDR 0x05
+#define LILO1_REG_ADDR 0x06
+#define LILO2_REG_ADDR 0x07
+#define BUCK1_V1_REG_ADDR 0x08
+#define BUCK1_V2_REG_ADDR 0x09
+#define BUCK2_V1_REG_ADDR 0x0a
+#define BUCK2_V2_REG_ADDR 0x0b
+#define BUCK_CTR_REG_ADDR 0x0c
+#define LDO_CTR_REG_ADDR 0x0d
+#define PULLDOWN_REG_ADDR 0x0e
+#define STATUS_REG_ADDR 0x0f
+
+#define LP8725_LDO_NUM 5
+#define LP8725_LILO_NUM 2
+#define LP8725_BUCK_NUM 2
+
+
+#define LDO_BUCKV1_TIME 5 //¸ß3 
+#define LDO_BUCKV_V 0 //µÚ5
+#define BUCKV2_CL_BIT 6 //¸ß2
+
+#ifdef DEFSEL_VIN1
+#define GENERAL_REG_DEFAULT 0x59 //0101 1001     buck1output  dependon dvs pin, dvs=1 v1 is used               buck2v1 is output
+
+#define LDO1_REG_T_DEFAULT 0x02 //1001 1001  
+#define LDO1_REG_V_DEFAULT 0x19
+#define LDO2_REG_T_DEFAULT 0x04 //1001 1001
+#define LDO2_REG_V_DEFAULT 0x19
+#define LDO3_REG_T_DEFAULT 0x05 // 1011 1111
+#define LDO3_REG_V_DEFAULT 0x1f
+#define LDO4_REG_T_DEFAULT 0x04 // 1001 1101
+#define LDO4_REG_V_DEFAULT 0x1d 
+#define LDO5_REG_T_DEFAULT 0x04 //1000 1100
+#define LDO5_REG_V_DEFAULT 0x0c
+
+#define LILO1_REG_T_DEFAULT 0x05 //1010 1000
+#define LILO1_REG_V_DEFAULT 0x08
+#define LILO2_REG_T_DEFAULT 0x02  // 0101 0000 
+#define LILO2_REG_V_DEFAULT 0x10
+
+#define BUCK1_V1_REG_T_DEFAULT 0x00 // 0000 0100
+#define BUCK1_V1_REG_V_DEFAULT 0x04
+
+#define BUCK1_V2_REG_C_DEFAULT 0x03 //1100 1000 ¸ß¶þ
+#define BUCK1_V2_REG_V_DEFAULT 0x08 
+
+#define BUCK2_V1_REG_T_DEFAULT 0x02  // 0101 0001
+#define BUCK2_V1_REG_V_DEFAULT 0x11
+
+#define BUCK2_V2_REG_C_DEFAULT 0x02//1001 0001  ¸ß¶þ
+#define BUCK2_V2_REG_V_DEFAULT 0x11// µÚ5
+
+#define BUCK2_CTR_REG_ADDR 0x11 // 0001 0001
+#define LDO_CTR_REG_DEFAULT 0x7f //0111 1111
+#define PULLDOWN_DEFAULT 0x7f //0111 1111
+#define STATUS_REG_DEFAULT 0x00 //0000 0000
+
+#else
+
+
+
+#define GENERAL_REG_DEFAULT 0x59 //0101 1001
+
+#define LDO1_REG_T_DEFAULT 0x01 // 0011 0101  
+#define LDO1_REG_V_DEFAULT 0x15
+#define LDO2_REG_T_DEFAULT 0x01 // 0011 1001
+#define LDO2_REG_V_DEFAULT 0x19
+
+#define LDO3_REG_T_DEFAULT 0x02 // 0101 1001
+#define LDO3_REG_V_DEFAULT 0x19
+#define LDO4_REG_T_DEFAULT 0x02 // 0101 1001
+#define LDO4_REG_V_DEFAULT 0x19 
+#define LDO5_REG_T_DEFAULT 0x01 // 0011 1001
+#define LDO5_REG_V_DEFAULT 0x19
+
+#define LILO1_REG_T_DEFAULT 0x01 //0011 1111
+#define LILO1_REG_V_DEFAULT 0x1f
+
+#define LILO2_REG_T_DEFAULT 0x00  // 0000 1000
+#define LILO2_REG_V_DEFAULT 0x08
+
+#define BUCK1_V1_REG_T_DEFAULT 0x00 // 0000 1000
+#define BUCK1_V1_REG_V_DEFAULT 0x08
+
+#define BUCK1_V2_REG_C_DEFAULT 0x03 //1100 0100 ¸ß¶þ
+#define BUCK1_V2_REG_V_DEFAULT 0x04 
+
+#define BUCK2_V1_REG_T_DEFAULT 0x01  // 0011 0001
+#define BUCK2_V1_REG_V_DEFAULT 0x11
+
+#define BUCK2_V2_REG_C_DEFAULT 0x02 //1001 0001  ¸ß¶þ
+#define BUCK2_V2_REG_V_DEFAULT 0x11// µÚ5
+
+#define BUCK_CTR_REG_ADDR 0x11 // 0001 0001
+#define LDO_CTR_REG_DEFAULT 0x7f //0111 1111
+#define PULLDOWN_REG_DEFAULT 0x7f //0111 1111
+#define STATUS_REG_DEFAULT 0x00 //0000 0000
+#endif
+
+
+struct i2c_client *lp8725_client;
+#define lp8725getbit(a,num) (((a)>>(num))&0x01)
+#define lp8725setbit(a,num) ((a)|(0x01<<(num)))
+#define lp8725clearbit(a,num) ((a)&(~(0x01<<(num))))
+
+
+static const struct i2c_device_id lp8725_id[] = 
+{
+     { "lp8725", 0, }, 
+    { }
+};
+
+MODULE_DEVICE_TABLE(i2c, lp8725_id);
+
+struct lp8725_regs_s
+{
+uint8_t general_reg_val;
+uint8_t ldo_reg_val[5];
+uint8_t lilo_reg_val[2];
+uint8_t buck_v1_reg_val[2];    
+uint8_t buck_v2_reg_val[2];    
+uint8_t buck_ctr_reg_val;      
+uint8_t ldo_ctr_reg_val;       
+uint8_t pulldown_reg_val;      
+uint8_t status_reg_val;        
+};
+struct lp8725_vol_range_s
+{
+  uint16_t vol_low;
+  uint16_t vol_high;
+  uint16_t rang;
+};
+
+
+static struct lp8725_regs_s lp8725_regs;
+
+
+uint8_t ldo_reg_t_default[LP8725_LDO_NUM]={LDO1_REG_T_DEFAULT,LDO2_REG_T_DEFAULT,LDO3_REG_T_DEFAULT,LDO4_REG_T_DEFAULT,LDO5_REG_T_DEFAULT};
+uint8_t ldo_reg_v_default[LP8725_LDO_NUM]={LDO1_REG_V_DEFAULT,LDO2_REG_V_DEFAULT,LDO3_REG_V_DEFAULT,LDO4_REG_V_DEFAULT,LDO5_REG_V_DEFAULT};
+
+uint8_t lilo_reg_t_default[LP8725_LILO_NUM]={LILO1_REG_T_DEFAULT,LILO2_REG_T_DEFAULT};
+uint8_t lilo_reg_v_default[LP8725_LILO_NUM]={LILO1_REG_V_DEFAULT,LILO2_REG_V_DEFAULT};
+
+uint8_t buck_v1_reg_t_default[LP8725_BUCK_NUM]={BUCK1_V1_REG_T_DEFAULT,BUCK2_V1_REG_T_DEFAULT};
+uint8_t buck_v1_reg_v_default[LP8725_BUCK_NUM]={BUCK1_V1_REG_V_DEFAULT,BUCK2_V1_REG_V_DEFAULT};
+
+uint8_t buck_v2_reg_c_default[LP8725_BUCK_NUM]={BUCK1_V2_REG_C_DEFAULT,BUCK2_V2_REG_C_DEFAULT};
+uint8_t buck_v2_reg_v_default[LP8725_BUCK_NUM]={BUCK1_V2_REG_V_DEFAULT,BUCK2_V2_REG_V_DEFAULT};
+
+
+#define LDO_RANG 5
+#define LILO_RANG 5
+#define BULK_RANG 6
+
+struct lp8725_vol_range_s ldo_vol_range[LDO_RANG]={{120,190,5},{190,260,10},{260,300,5},{300,310,10},{310,330,20}};
+struct lp8725_vol_range_s lilo_vol_range[LILO_RANG]={{80,140,5},{140,280,10},{280,290,5},{290,310,10},{310,330,20}};
+struct lp8725_vol_range_s buck_vol_range[BULK_RANG]={{80,140,5},{140,170,10},{170,190,5},{190,280,10},{280,290,5},{290,300,10}};
+/* **********************************************************************
+ *  Ð´¼Ä´æÆ÷
+ * return    <0 failed
+ * * ***********************************************************************/
+static int lp8725_write_reg(struct i2c_client *client, uint8_t reg, uint8_t val)
+{
+       int ret=-1;
+       DBG("**run in %s**\n",__FUNCTION__);
+       struct i2c_adapter *adap;
+       struct i2c_msg msg;
+       char tx_buf[2];
+       if(!client)
+               return ret;    
+       adap = client->adapter;         
+       tx_buf[0] = reg;
+       tx_buf[1]=val;
+       //DBG("**run in %s**\n",__FUNCTION__);
+
+       msg.addr = client->addr;
+       msg.buf = &tx_buf[0];
+       msg.len = 1 +1;
+       msg.flags = client->flags;   
+       msg.scl_rate = 200*1000;
+       //DBG("**run in %s**\n",__FUNCTION__);
+
+       ret = i2c_transfer(adap, &msg, 1);
+       //DBG("**run in %s**\n",__FUNCTION__);
+       return ret;    
+       DBG("**run out %s**\n",__FUNCTION__);
+}
+/* **********************************************************************
+ *  ¶Á¼Ä´æÆ÷
+ * return    <0 failed
+ * * ***********************************************************************/
+ #if 1
+static int lp8725_read_reg(struct i2c_client *client, uint8_t reg, uint8_t *val)
+{
+
+    int ret;
+    struct i2c_adapter *adap;
+    struct i2c_msg msgs[2];
+    if(!client)
+               return ret;    
+    adap = client->adapter;            
+    //·¢ËͼĴæÆ÷µØÖ·
+    msgs[0].addr = client->addr;
+    msgs[0].buf = &reg;
+    msgs[0].flags = client->flags;
+    msgs[0].len = 1;
+    msgs[0].scl_rate = 200*1000;
+    //½ÓÊÕÊý¾Ý
+    //msgs[1].buf = val;
+    DBG("msgs[1].buf = %d\n",*msgs[1].buf);
+       //msgs[1].buf = val;    
+       msgs[1].buf = val;
+    msgs[1].addr = client->addr;
+    msgs[1].flags = client->flags | I2C_M_RD;
+    msgs[1].len = 1;
+    msgs[1].scl_rate = 200*1000;
+
+    ret = i2c_transfer(adap, msgs, 2);
+    //DBG("**has run at %s %d ret=%d**\n",__FUNCTION__,__LINE__,ret);
+       DBG("msgs[1].buf = %d\n",*(msgs[1].buf));
+
+    return ret;     
+}
+#else
+static int lp8725_read_reg(struct i2c_client *client, uint8_t reg)
+{
+
+  int ret;
+       struct i2c_adapter *adap;
+       struct i2c_msg msgs[2];
+       if(!client)
+       return ret;    
+       adap = client->adapter;         
+       //·¢ËͼĴæÆ÷µØÖ·
+       msgs[0].addr = client->addr;
+       msgs[0].buf = &reg;
+       msgs[0].flags = client->flags;
+       msgs[0].len = 1;
+       msgs[0].scl_rate = 200*1000;
+       //½ÓÊÕÊý¾Ý
+       msgs[1].buf;
+       msgs[1].addr = client->addr;
+       msgs[1].flags = client->flags | I2C_M_RD;
+       msgs[1].len = 1;
+       msgs[1].scl_rate = 200*1000;
+
+       ret = i2c_transfer(adap, msgs, 2);
+       //DBG("**has run at %s %d ret=%d**\n",__FUNCTION__,__LINE__,ret);
+       DBG("msgs[1].buf = %d\n",*msgs[1].buf);
+       return ret;     
+}
+#endif
+/* **********************************************************************
+ *  ÉèÖÃldoµÄÊä³öµçѹ
+ *ldon:ldo±àºÅ Èçldo1 ldon=1£¬vol µçѹµ¥Î»10mv    Èç1.2v  vol=120
+ *µçѹ·¶Î§:´Ó1.2v¿ªÊ¼²½½ø0.05v
+ * return    <0 failed
+ * * ***********************************************************************/
+int lp8725_set_ldo_vol(uint8_t ldon,uint16_t vol)
+{
+
+       uint8_t val=0;
+       uint8_t reg_val=0;
+       int i;
+
+       if((vol>ldo_vol_range[LDO_RANG-1].vol_high)||(vol<ldo_vol_range[0].vol_low)||ldon>LP8725_LDO_NUM)
+               return -1;
+       
+       for(i=0;i<LDO_RANG;i++)
+       {
+               if(vol<=ldo_vol_range[i].vol_high)
+               {
+                       val+=(vol-ldo_vol_range[i].vol_low)/ldo_vol_range[i].rang;
+                       break;
+               }
+               else
+                       val+=(ldo_vol_range[i].vol_high-ldo_vol_range[i].vol_low)/ldo_vol_range[i].rang;
+               DBG("val=0x%x,vol=%d\n",val,vol);
+       }
+       
+       DBG("val=0x%x,vol=%d\n",val,vol);
+
+       reg_val=(ldo_reg_t_default[ldon-1]<<LDO_BUCKV1_TIME)|val;
+       DBG("ldo_reg_t_default[ldon-1]=0x%x,LDO_BUCKV1_TIME=0x%x\n",ldo_reg_t_default[ldon-1],LDO_BUCKV1_TIME);
+       DBG("ldo_reg_t_default[ldon-1]<<LDO_BUCKV1_TIME=0x%x\n",ldo_reg_t_default[ldon-1]<<LDO_BUCKV1_TIME);
+       DBG("ADDR=0x%x,reg_val=0x%x\n",LDO1_REG_ADDR+ldon-1,reg_val);
+
+       if(lp8725_write_reg(lp8725_client,LDO1_REG_ADDR+ldon-1,reg_val)<0)
+       {
+               DBGERR("%s %d error\n",__FUNCTION__,__LINE__);
+               return -1;
+       }
+       
+       lp8725_regs.ldo_reg_val[ldon-1]=reg_val;
+       return 0;
+}
+
+/* **********************************************************************
+ *  ÉèÖÃliloµÄÊä³öµçѹ
+ *ldon:ldo±àºÅ Èçlilo1 lilon=1£¬vol µçѹµ¥Î»10mv    Èç0.8v  vol=80
+ *µçѹ·¶Î§:µçѹÔÚ[0.8,1.4]ʱ²½½ø0.05v£¬µçѹÔÚ[1.4,3.3]ʱ²½½ø0.1v
+ * return    <0 failed
+ * * ***********************************************************************/
+int lp8725_set_lilo_vol(uint8_t lilon,uint16_t vol)
+{
+
+       uint8_t val=0;
+       uint8_t reg_val=0;
+       int i;
+
+       if((vol>lilo_vol_range[LILO_RANG-1].vol_high)||(vol<lilo_vol_range[0].vol_low)||lilon>LP8725_LILO_NUM)
+       return -1;
+
+       for(i=0;i<LILO_RANG;i++)
+       {
+               if(vol<=lilo_vol_range[i].vol_high)
+               {
+                       val+=(vol-lilo_vol_range[i].vol_low)/lilo_vol_range[i].rang;
+                       break;
+               }
+               else
+                       val+=(lilo_vol_range[i].vol_high-lilo_vol_range[i].vol_low)/lilo_vol_range[i].rang;
+       }
+       
+       reg_val=(lilo_reg_t_default[lilon-1]<<LDO_BUCKV1_TIME)|val;
+       
+       if(lp8725_write_reg(lp8725_client,LILO1_REG_ADDR+lilon-1,reg_val)<0)
+       {
+               DBGERR("%s %d error\n",__FUNCTION__,__LINE__);
+               return -1;
+       }
+       
+       lp8725_regs.lilo_reg_val[lilon-1]=reg_val;
+       
+       return 0;
+}
+
+
+/* **********************************************************************
+*  ÉèÖÃbuckµÄv1 v2  Êä³öµçѹ¿ØÖƼĴæÆ÷
+*ldon:ldo±àºÅ Èçbuck1 buckn=1£¬vol µçѹµ¥Î»10mv    Èç0.8v  vol=80 £¬v2=1 ½«µçѹֵдÈëv2 reg£¬·ñÔòдÈëv1 reg
+*µçѹ·¶Î§:µçѹÔÚ[0.8,1.4]ʱ²½½ø0.05v£¬µçѹÔÚ[1.4,1.7]ʱ²½½ø0.1v£¬
+*µçѹÔÚ[1.7,1.9]ʱ²½½ø0.05v£¬µçѹÔÚ[1.9,3.0]ʱ²½½ø0.1v
+* return    <0 failed
+* * ***********************************************************************/
+static int lp8725_set_buck_vol_v1orv2(uint8_t buckn,uint16_t vol,uint8_t v2)
+{
+
+       uint8_t val=0;
+       uint8_t reg_val=0;
+       uint8_t reg_addr=0;
+       int i;
+
+       if(vol>buck_vol_range[BULK_RANG-1].vol_high||vol<buck_vol_range[0].vol_low||buckn>LP8725_BUCK_NUM)
+               return -1;
+
+       for(i=0;i<BULK_RANG;i++)
+       {
+               if(vol<=buck_vol_range[i].vol_high)
+               {
+                       val+=(vol-buck_vol_range[i].vol_low)/buck_vol_range[i].rang;
+                       break;
+               }
+               else
+                       val+=(buck_vol_range[i].vol_high-buck_vol_range[i].vol_low)/buck_vol_range[i].rang;
+       }
+
+       reg_addr=BUCK1_V1_REG_ADDR+(buckn-1)*2;
+       reg_val=(buck_v1_reg_t_default[buckn-1]<<LDO_BUCKV1_TIME)|val;
+
+       if(v2)
+               reg_addr=BUCK1_V2_REG_ADDR+(buckn-1)*2;
+
+
+       if(lp8725_write_reg(lp8725_client,reg_addr,reg_val)<0)
+       {
+               DBGERR("%s %d error\n",__FUNCTION__,__LINE__);
+               return -1;
+       }
+
+       if(v2)
+               lp8725_regs.buck_v2_reg_val[buckn-1]=reg_val;
+       else
+               lp8725_regs.buck_v1_reg_val[buckn-1]=reg_val;
+
+       return 0;
+}
+/***************************************************************
+*
+*
+****************************************************************/
+int lp8725_set_buck_dvsn_v_bit(uint8_t buckn,uint8_t dvs)
+{
+
+
+       uint8_t reg_val=0;
+
+       if(dvs)
+       reg_val=lp8725_regs.general_reg_val|(0x01<<(2+buckn-1));
+       else
+       reg_val=lp8725_regs.general_reg_val&(~0x01<<(12+buckn-1));
+
+          
+       if(lp8725_write_reg(lp8725_client,GENERAL_REG_ADDR,reg_val)<0)
+       {
+
+               DBGERR("%s %d error\n",__FUNCTION__,__LINE__);
+               return -1;
+       }
+
+       lp8725_regs.general_reg_val=reg_val;
+
+       return 0;
+}
+/* **********************************************************************
+*  ÉèÖÃbuckµÄÊä³öµçѹ
+*ldon:ldo±àºÅ Èçbuck1 buckn=1£¬vol µçѹµ¥Î»10mv    Èç0.8v  vol=80
+*µçѹ·¶Î§:µçѹÔÚ[0.8,1.4]ʱ²½½ø0.05v£¬µçѹÔÚ[1.4,1.7]ʱ²½½ø0.1v£¬
+*µçѹÔÚ[1.7,1.9]ʱ²½½ø0.05v£¬µçѹÔÚ[1.9,3.0]ʱ²½½ø0.1v
+*ÿ¸öbuck ÓÐÁ½µçѹ¼Ä´æÆ÷v1¡¢v2£¬buck µÄÊä³öµçѹ¸ù¾ÝÒ»¶¨Ìõ¼þ£¬
+*Ñ¡Ôñ¸ù¾ÝÄǸö¼Ä´æÆ÷µÄÖµÊä³öµçѹ
+* buck1: dvs1_v=1 output vol depend on  buck1_v1 reg,else depend on dvs pin. dvspin=1 output vol depend on  buck1_v1,esle output vol depend on  buck1_v2
+*buck2:dvs1_v=1 output vol depend on  buck2_v1 reg,else depend on buck2_v2. 
+* return    <0 failed
+* * ***********************************************************************/
+
+ int lp8725_set_buck_vol(uint8_t buckn,uint16_t vol)
+ {
+       
+       if(lp8725_set_buck_vol_v1orv2(buckn,vol,0)<0)
+       return -1;
+
+       return lp8725_set_buck_vol_v1orv2(buckn,vol,1);
+       
+}
+
+int get_dvs_pin_level(void)
+{
+
+// dvs pin is low   return 0
+
+}
+int set_dvs_pin_level(uint8_t level)
+{
+
+
+
+}
+/*******************************************************************************
+*in sleep mode all pins val is low
+*reg SLEEP_MODE=0,and pin DVS=0£¬this ic enter into seelp mode
+********************************************************************************/
+int lp8725_setinto_sleep(uint8_t sleep)
+{
+
+
+       uint8_t reg_val=0;
+       set_dvs_pin_level(0);
+
+       if(sleep)
+               reg_val=lp8725_regs.general_reg_val|(0x01<<1);
+       else
+               reg_val=lp8725_regs.general_reg_val&(~0x01<<1);
+       if(lp8725_write_reg(lp8725_client,GENERAL_REG_ADDR,reg_val)<0)
+       {
+
+               DBGERR("%s %d error\n",__FUNCTION__,__LINE__);
+               return -1;
+       }
+       lp8725_regs.general_reg_val=reg_val;
+       return 0;
+}
+/***************************************************************
+*
+*
+****************************************************************/
+int lp8725_buck_en(uint8_t buckn,uint8_t enble)
+{
+
+
+       uint8_t reg_val=0;
+
+       if(buckn==1)
+       {
+               if(enble)
+                       reg_val=lp8725_regs.general_reg_val|0x01;
+               else
+                       reg_val=lp8725_regs.general_reg_val&(~0x01);
+       }
+
+        if(buckn==2)
+       {
+               if(enble)
+                       reg_val=lp8725_regs.general_reg_val|(0x01<<4);
+               else
+                       reg_val=lp8725_regs.general_reg_val&(~0x01<<4);
+       }
+        
+       if(lp8725_write_reg(lp8725_client,GENERAL_REG_ADDR,reg_val)<0)
+       {
+
+               DBGERR("%s %d error\n",__FUNCTION__,__LINE__);
+               return -1;
+       }
+
+       lp8725_regs.general_reg_val=reg_val;
+
+       return 0;
+}
+
+
+
+int lp8725_lilo_en(uint8_t lilon,uint8_t enble)
+{
+       uint8_t reg_val=0;
+
+               if(enble)
+                       reg_val=lp8725_regs.ldo_ctr_reg_val|(0x01<<(5+lilon-1));
+               else
+                       reg_val=lp8725_regs.ldo_ctr_reg_val&(~(0x01<<(5+lilon-1)));
+        
+       if(lp8725_write_reg(lp8725_client,LDO_CTR_REG_ADDR,reg_val)<0)
+       {
+
+               DBGERR("%s %d error\n",__FUNCTION__,__LINE__);
+               return -1;
+       }
+
+       lp8725_regs.ldo_ctr_reg_val=reg_val;
+
+       return 0;
+}
+/***************************************************************
+*ldo3 is enbale if pin LdO3_EN=1 or LDO3 enable reg=1   
+*
+****************************************************************/
+int lp8725_ldo_en(uint8_t ldo,uint8_t enble)
+{
+
+
+       uint8_t reg_val=0;
+
+               if(enble)
+                       reg_val=lp8725_regs.ldo_ctr_reg_val|(0x01<<(ldo-1));
+               else
+                       reg_val=lp8725_regs.ldo_ctr_reg_val&(~(0x01<<(ldo-1)));
+
+        
+       if(lp8725_write_reg(lp8725_client,LDO_CTR_REG_ADDR,reg_val)<0)
+       {
+               DBGERR("%s %d error\n",__FUNCTION__,__LINE__);
+               return -1;
+       }
+
+       lp8725_regs.ldo_ctr_reg_val=reg_val;
+
+       return 0;
+}
+
+
+
+void lp8725_set_init(void)
+{
+
+       uint8_t reg_val=0;      
+       uint8_t read_ret;
+       lp8725_regs.general_reg_val=GENERAL_REG_DEFAULT;
+       lp8725_regs.buck_ctr_reg_val=BUCK_CTR_REG_ADDR;
+       lp8725_regs.pulldown_reg_val=PULLDOWN_REG_ADDR;
+       lp8725_regs.status_reg_val=STATUS_REG_ADDR;
+       /*
+       ¿ª»úºóldo 1¡¢2¡¢5 lilo2ĬÈÏΪ¹Ø±Õ
+       */
+       DBG("**run in %s**\n",__FUNCTION__);
+       //reg_val=LDO_CTR_REG_ADDR&&(~(1<<0))&&(~(1<<0))&&(~(1<<1))&&(~(1<<4))&&(~(1<<6));
+       reg_val=0x7f;
+       DBG("**lp8725_client=%s**LDO_CTR_REG_ADDR=%d**reg_val=%d\n",lp8725_client,LDO_CTR_REG_ADDR,reg_val);
+       if(lp8725_write_reg(lp8725_client,LDO_CTR_REG_ADDR,reg_val)<0)
+       {
+               DBG("%s %d error\n",__FUNCTION__,__LINE__);
+               return -1;
+       }       
+
+       /*
+       **set ldo4 VCCA 3.3V;ldo5 AVDD18 1.8v
+       */
+       lp8725_set_ldo_vol(4,330);
+       lp8725_set_ldo_vol(5,180);
+
+
+
+
+
+       
+#if 0
+       DBG("**begin lp8725_read_reg %s %d \n",__FUNCTION__,__LINE__);
+       if(lp8725_read_reg(lp8725_client,0x00,&read_ret)<0)
+       {
+               DBG("%s %d error\n",__FUNCTION__,__LINE__);
+               return -1;
+       }
+       DBG("**lp8725_read_reg %s %d return read_ret = %d\n",__FUNCTION__,__LINE__,read_ret);
+#endif
+
+       lp8725_regs.ldo_ctr_reg_val=reg_val;
+       
+       DBG("**run out %s**\n",__FUNCTION__);
+}
+
+#if 0
+static __init int seqgen1_init(void)
+{
+       uint8_t *read_val;
+       //uint8_t reg_val=0x98;
+       DBG("**************run in %s\n",__FUNCTION__);
+       //lp8725_set_ldo_vol(2,150);
+       //lp8725_set_lilo_vol(2,150);
+       //lp8725_set_buck_vol(2,170);
+
+       while(1)
+       {
+               DBG("\n***lp8725_lilo_en(2,0)\n");
+               lp8725_lilo_en(2,0);
+               mdelay(6000);
+               DBG("\n***lp8725_lilo_en(2,1)\n");
+               lp8725_lilo_en(2,1);
+               mdelay(6000);
+       }
+       
+#if 0
+       while(1)
+       {
+               int i;
+               for(i=180;i<=330;i=i-10)
+               {
+                       DBG("\n\n**i=%d\n",i);
+                       DBG("**************run in %s\n",__FUNCTION__);
+                       lp8725_set_buck_vol(2,i);
+                       mdelay(3000);
+               }               
+       }
+       DBG("**************run out %s\n",__FUNCTION__);
+       
+       
+       if(lp8725_write_reg(lp8725_client,LDO2_REG_ADDR,reg_val)<0)
+       {
+               DBG("%s %d error\n",__FUNCTION__,__LINE__);
+               return -1;
+       }
+
+       while(1)
+       {
+               lp8725_read_reg(lp8725_client,LDO_CTR_REG_ADDR,read_val);
+               DBG("\n*****read_val = %d\n",read_val);
+       }       
+       DBG("**************run out %s\n",__FUNCTION__);
+#endif 
+       return 0;       
+}
+late_initcall(seqgen1_init);
+#endif
+
+
+static int __devinit lp8725_probe(struct i2c_client *client,const struct i2c_device_id *id)
+{
+       int ret;
+
+       DBG("**%s in %d line,dev adr is %x**\n",__FUNCTION__,__LINE__,client->addr);
+       if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C))
+               return -EIO;
+       lp8725_client=client;
+       lp8725_set_init();
+
+       DBG("**run out %s**\n",__FUNCTION__);
+    return 0;
+}
+
+static int lp8725_remove(struct i2c_client *client)
+{
+       
+       return 0;
+}
+
+static struct i2c_driver lp8725_driver = {
+    .driver = {
+                 .owner  = THIS_MODULE,
+        .name   = "lp8725",
+    },
+    .probe      = lp8725_probe,
+    .remove     = lp8725_remove,
+    .id_table   = lp8725_id,
+};
+
+static int __init lp8725_init(void)
+{
+       int ret;        
+       ret = i2c_add_driver(&lp8725_driver);
+       DBG("**lp8725_init return %d**\n",ret);
+       return ret;
+}
+static void __exit lp8725_exit(void)
+{
+       i2c_del_driver(&lp8725_driver);
+}
+
+module_init(lp8725_init);
+module_exit(lp8725_exit);
+MODULE_AUTHOR(" XXX  XXX@rock-chips.com");
+MODULE_DESCRIPTION("Driver for rk2818 extend gpio device");
+MODULE_LICENSE("GPL");
+
+
index 0d64c692012d427d654c884ca8be670683600c48..78e38548c35b1b2c9b63a8ce56b55f8d5f6cc4dd 100644 (file)
@@ -51,6 +51,7 @@ config SND_SOC_ALL_CODECS
        select SND_SOC_WM8988 if SND_SOC_I2C_AND_SPI
        select SND_SOC_WM8990 if I2C
        select SND_SOC_WM8993 if I2C
+       select SND_SOC_WM8994 if SND_SOC_I2C_AND_SPI
        select SND_SOC_WM9081 if I2C
        select SND_SOC_WM9705 if SND_SOC_AC97_BUS
        select SND_SOC_WM9712 if SND_SOC_AC97_BUS
@@ -205,6 +206,9 @@ config SND_SOC_WM8990
 config SND_SOC_WM8993
        tristate
 
+config SND_SOC_WM8994
+       tristate
+
 config SND_SOC_WM9081
        tristate
 
index 61b5ae365a36a4cc47ec5b57ad0c156a4dc7862d..36af1ce465dfc248d4876e9539f79ce4904e675d 100644 (file)
@@ -39,6 +39,7 @@ snd-soc-wm8974-objs := wm8974.o
 snd-soc-wm8988-objs := wm8988.o
 snd-soc-wm8990-objs := wm8990.o
 snd-soc-wm8993-objs := wm8993.o
+snd-soc-wm8994-objs := wm8994.o
 snd-soc-wm9081-objs := wm9081.o
 snd-soc-wm9705-objs := wm9705.o
 snd-soc-wm9712-objs := wm9712.o
@@ -89,6 +90,7 @@ obj-$(CONFIG_SND_SOC_WM8961)  += snd-soc-wm8961.o
 obj-$(CONFIG_SND_SOC_WM8988)   += snd-soc-wm8988.o
 obj-$(CONFIG_SND_SOC_WM8990)   += snd-soc-wm8990.o
 obj-$(CONFIG_SND_SOC_WM8993)   += snd-soc-wm8993.o
+obj-$(CONFIG_SND_SOC_WM8994)   += snd-soc-wm8994.o
 obj-$(CONFIG_SND_SOC_WM9081)   += snd-soc-wm9081.o
 obj-$(CONFIG_SND_SOC_WM9705)   += snd-soc-wm9705.o
 obj-$(CONFIG_SND_SOC_WM9712)   += snd-soc-wm9712.o
diff --git a/sound/soc/codecs/wm8994.c b/sound/soc/codecs/wm8994.c
new file mode 100755 (executable)
index 0000000..3f7df26
--- /dev/null
@@ -0,0 +1,2691 @@
+/*
+ * wm8994.c -- WM8994 ALSA SoC audio driver
+ *
+ * Copyright 2009 Wolfson Microelectronics plc
+ * Copyright 2005 Openedhand Ltd.
+ *
+ * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+
+#include <linux/module.h>
+#include <linux/moduleparam.h>
+#include <linux/init.h>
+#include <linux/delay.h>
+#include <linux/pm.h>
+#include <linux/i2c.h>
+#include <linux/spi/spi.h>
+#include <linux/platform_device.h>
+#include <sound/core.h>
+#include <sound/pcm.h>
+#include <sound/pcm_params.h>
+#include <sound/tlv.h>
+#include <sound/soc.h>
+#include <sound/soc-dapm.h>
+#include <sound/initval.h>
+
+#include <mach/iomux.h>
+#include <mach/gpio.h>
+
+#include "wm8994.h"
+
+
+#if 1
+#define DBG(x...) printk(KERN_INFO x)
+#else
+#define DBG(x...) do { } while (0)
+#endif
+
+#define WM8994_TEST
+
+struct i2c_client *wm8994_client;
+int reg_send_data(struct i2c_client *client, unsigned short *reg, unsigned short *data, u32 scl_rate);
+int reg_recv_data(struct i2c_client *client, unsigned short *reg, unsigned short *buf, u32 scl_rate);
+
+enum wm8994_codec_mode
+{
+  wm8994_AP_to_Headset,
+  wm8994_AP_to_Speakers,
+  wm8994_Recorder,
+  wm8994_FM_to_Headset,
+  wm8994_FM_to_Headset_and_Record,
+  wm8994_FM_to_Speakers,
+  wm8994_FM_to_Speakers_and_Record,
+  wm8994_HandsetMIC_to_Baseband_to_Headset,
+  wm8994_HandsetMIC_to_Baseband_to_Headset_and_Record,
+  wm8994_MainMIC_to_Baseband_to_Earpiece,
+  wm8994_MainMIC_to_Baseband_to_Earpiece_and_Record,
+  wm8994_MainMIC_to_Baseband_to_Speakers,
+  wm8994_MainMIC_to_Baseband_to_Speakers_and_Record,
+  wm8994_BT_Baseband,
+  wm8994_BT_Baseband_and_record,
+///PCM BB BEGIN
+  wm8994_HandsetMIC_to_PCMBaseband_to_Headset,
+  wm8994_HandsetMIC_to_PCMBaseband_to_Headset_and_Record,
+  wm8994_MainMIC_to_PCMBaseband_to_Earpiece,
+  wm8994_MainMIC_to_PCMBaseband_to_Earpiece_and_Record,
+  wm8994_MainMIC_to_PCMBaseband_to_Speakers,
+  wm8994_MainMIC_to_PCMBaseband_to_Speakers_and_Record,
+  wm8994_BT_PCMBaseband,
+  wm8994_BT_PCMBaseband_and_record,
+///PCM BB END
+  null
+};
+
+unsigned char wm8994_mode=null;
+
+/* For voice device route set, add by phc  */
+enum VoiceDeviceSwitch
+{
+       SPEAKER_INCALL,
+       SPEAKER_NORMAL,
+       
+       HEADSET_INCALL,
+       HEADSET_NORMAL,
+
+       EARPIECE_INCALL,
+       EARPIECE_NORMAL,
+       
+       BLUETOOTH_SCO_INCALL,
+       BLUETOOTH_SCO_NORMAL,
+
+       BLUETOOTH_A2DP_INCALL,
+       BLUETOOTH_A2DP_NORMAL,
+       
+       MIC_CAPTURE,
+       
+       ALL_OPEN,
+       ALL_CLOSED
+};
+/*
+ * wm8994 register cache
+ * We can't read the WM8994 register space when we
+ * are using 2 wire for device control, so we cache them instead.
+ */
+static const u16 wm8994_reg[] = {
+       0x0097, 0x0097, 0x0079, 0x0079,  /*  0 */
+       0x0000, 0x0008, 0x0000, 0x000a,  /*  4 */
+       0x0000, 0x0000, 0x00ff, 0x00ff,  /*  8 */
+       0x000f, 0x000f, 0x0000, 0x0000,  /* 12 */
+       0x0000, 0x007b, 0x0000, 0x0032,  /* 16 */
+       0x0000, 0x00c3, 0x00c3, 0x00c0,  /* 20 */
+       0x0000, 0x0000, 0x0000, 0x0000,  /* 24 */
+       0x0000, 0x0000, 0x0000, 0x0000,  /* 28 */
+       0x0000, 0x0000, 0x0050, 0x0050,  /* 32 */
+       0x0050, 0x0050, 0x0050, 0x0050,  /* 36 */
+       0x0079, 0x0079, 0x0079,          /* 40 */
+};
+
+/* codec private data */
+struct wm8994_priv {
+       unsigned int sysclk;
+       struct snd_soc_codec codec;
+       struct snd_pcm_hw_constraint_list *sysclk_constraints;
+       u16 reg_cache[WM8994_NUM_REG];
+};
+
+static int wm8994_read(unsigned short reg,unsigned short *value)
+{
+       unsigned short regs=((reg>>8)&0x00FF)|((reg<<8)&0xFF00),values;
+
+       if (reg_recv_data(wm8994_client,&regs,&values,400000) >= 0)
+       {
+               *value=((values>>8)& 0x00FF)|((values<<8)&0xFF00);
+               DBG("Enter::%s----line->%d--reg=0x%x value=%x\n",__FUNCTION__,__LINE__,reg,*value);
+               return 0;
+       }
+       printk("%s---line->%d:Codec read error!\n",__FUNCTION__,__LINE__);
+       return -EIO;
+}
+       
+
+static int wm8994_write(unsigned short reg,unsigned short value)
+{
+       unsigned short regs=((reg>>8)&0x00FF)|((reg<<8)&0xFF00),values=((value>>8)&0x00FF)|((value<<8)&0xFF00);
+
+       DBG("Enter::%s----line->%d-- reg=%x--value=%x -- regs=%x--values=%x\n",__FUNCTION__,__LINE__,reg,value,regs,values);
+
+       if (reg_send_data(wm8994_client,&regs,&values,400000)>=0)
+               return 0;
+
+       printk("%s---line->%d:Codec write error!\n",__FUNCTION__,__LINE__);
+       return -EIO;
+}
+
+#define wm8994_reset() wm8994_write(WM8994_RESET, 0)
+
+void  AP_to_Headset(void)
+{
+       DBG("Enter::%s----line->%d-- AP_to_Headset\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_AP_to_Headset;
+       wm8994_reset();
+       mdelay(50);
+
+#if 1
+       wm8994_write(0x01,  0x0003);
+       mdelay(50);
+       wm8994_write(0x221, 0x0700);  
+       wm8994_write(0x222, 0x90C2);  //86C2    
+       wm8994_write(0x223, 0x00E0);
+
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x302, 0x4000);  // master = 0x4000 // slave= 0x0000
+       wm8994_write(0x303, 0x0050);  // master  0x0050 lrck 40.98kHz bclk 2.15MHz
+       wm8994_write(0x305, 0x0035);  // master  0x0035 lrck 40.98kHz bclk 2.15MHz
+#endif
+
+       wm8994_write(0x220, 0x0005);  
+       mdelay(50);
+       wm8994_write(0x200, 0x0001);  // sysclk = fll (bit4 =1)   0x0011
+       wm8994_write(0x300, 0x4010);  // i2s 16 bits
+  
+       wm8994_write(0x01,  0x0303); 
+       wm8994_write(0x05,  0x0303);   
+       wm8994_write(0x2D,  0x0100);
+       wm8994_write(0x2E,  0x0100);
+       wm8994_write(0x4C,  0x9F25);
+       wm8994_write(0x60,  0x00EE);
+       wm8994_write(0x208, 0x000A);        
+       wm8994_write(0x420, 0x0000); 
+       wm8994_write(0x601, 0x0001);
+       wm8994_write(0x602, 0x0001);
+    
+       wm8994_write(0x610, 0x0190);  //DAC1 Left Volume bit0~7                 
+       wm8994_write(0x611, 0x0190);  //DAC1 Right Volume bit0~7        
+       wm8994_write(0x03,  0x0300);
+       wm8994_write(0x22,  0x0000);    
+       wm8994_write(0x23,  0x0100);
+       wm8994_write(0x36,  0x0003);
+
+#endif
+#if 0
+       wm8994_write(0x01,  0x0003);  
+       mdelay(50);
+       wm8994_write(0x221, 0x0700);  
+       wm8994_write(0x222, 0x3127);    
+       wm8994_write(0x223, 0x0100);    
+       wm8994_write(0x220, 0x0004);
+       mdelay(50);
+       wm8994_write(0x220, 0x0005);  
+
+       wm8994_write(0x01,  0x0303);  // sysclk = fll (bit4 =1)   0x0011 
+       wm8994_write(0x05,  0x0303);  // i2s 16 bits
+  
+       wm8994_write(0x2D,  0x0100);
+       wm8994_write(0x2E,  0x0100);
+       wm8994_write(0x4C,  0x9F25);
+       wm8994_write(0x60,  0x00EE);
+       wm8994_write(0x200, 0x0011);    
+       wm8994_write(0x208, 0x000A);    
+       wm8994_write(0x601, 0x0001);
+       wm8994_write(0x602, 0x0001);
+
+       wm8994_write(0x610, 0x01C0);            
+       wm8994_write(0x611, 0x01C0);            
+       wm8994_write(0x420, 0x0000);
+#endif
+
+}
+
+void  AP_to_Speakers(void)
+{
+       DBG("Enter::%s----line->%d-- AP_to_Speakers\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_AP_to_Speakers;
+       wm8994_reset();
+       mdelay(50);
+
+#if 1  // codec slave
+       wm8994_write(0x01,  0x0003);
+       mdelay(50);
+       wm8994_write(0x221, 0x0700);
+       wm8994_write(0x222, 0x90C2);
+       wm8994_write(0x223, 0x00E0);
+
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x302, 0x4000);  // master = 0x4000  slave= 0x0000
+       wm8994_write(0x303, 0x0050);  // master  0x0050 lrck 40.98kHz bclk 2.15MHz
+       wm8994_write(0x305, 0x0035);  // master  0x0035 lrck 40.98kHz bclk 2.15MHz
+#endif
+
+       wm8994_write(0x220, 0x0005);  
+       mdelay(50);
+       wm8994_write(0x200, 0x0001);  // sysclk = fll (bit4 =1)   0x0011
+       wm8994_write(0x300, 0x4010);  // i2s 16 bits
+  
+       wm8994_write(0x01,  0x3003); 
+       wm8994_write(0x05,  0x0303);   
+       wm8994_write(0x2D,  0x0100);
+       wm8994_write(0x2E,  0x0100);
+       wm8994_write(0x4C,  0x9F25);
+       wm8994_write(0x60,  0x00EE);
+       wm8994_write(0x208, 0x000A);
+       wm8994_write(0x420, 0x0000); 
+       
+       wm8994_write(0x601, 0x0001);
+       wm8994_write(0x602, 0x0001);
+    
+       wm8994_write(0x610, 0x01c0);  //DAC1 Left Volume bit0~7 
+       wm8994_write(0x611, 0x01c0);  //DAC1 Right Volume bit0~7        
+       wm8994_write(0x03,  0x0300);
+       wm8994_write(0x22,  0x0000);    
+       wm8994_write(0x23,  0x0100);
+       wm8994_write(0x36,  0x0003);    
+       mdelay(50);
+#endif
+#if 0
+       wm8994_write(0x01,  0x0003);  
+       mdelay(50);
+       wm8994_write(0x221, 0x0700);  
+       wm8994_write(0x222, 0x3127);    
+       wm8994_write(0x223, 0x0100);    
+       wm8994_write(0x220, 0x0004);
+       mdelay(50);
+       wm8994_write(0x220, 0x0005);  
+
+       wm8994_write(0x01,  0x3003);  // sysclk = fll (bit4 =1)   0x0011 
+       wm8994_write(0x03,  0x0330);
+       wm8994_write(0x05,  0x0303);  // i2s 16 bits
+
+       wm8994_write(0x22,  0x0000);
+       wm8994_write(0x23,  0x0100);
+       wm8994_write(0x2D,  0x0001);
+       wm8994_write(0x2E,  0x0001);
+//     wm8994_write(0x4C,  0x9F25);
+//     wm8994_write(0x60,  0x00EE);
+       wm8994_write(0x200, 0x0011);    
+       wm8994_write(0x208, 0x000A);    
+       wm8994_write(0x601, 0x0001);
+       wm8994_write(0x602, 0x0001);
+
+       wm8994_write(0x610, 0x01C0);            
+       wm8994_write(0x611, 0x01C0);
+       wm8994_write(0x620, 0x0000);
+       wm8994_write(0x420, 0x0000);
+#endif
+}
+
+void  Recorder(void)
+{
+       DBG("Enter::%s----line->%d-- Recorder\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_Recorder;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01,   0x0013);
+       mdelay(50);
+       wm8994_write(0x221,  0x0D00);
+       wm8994_write(0x222,  0x3300);
+       wm8994_write(0x223,  0x00E0);
+
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x302,  0x4000);  //master = 0x4000  slave= 0x0000
+       wm8994_write(0x303,  0x0090);  //master  0x0090 lrck1 8kHz bclk1 515KHz
+       wm8994_write(0x305,  0x00F0);  //master  0x00F0 lrck1 8kHz bclk1 515KHz
+#endif
+
+       wm8994_write(0x220,  0x0004);
+       mdelay(50);
+       wm8994_write(0x220,  0x0005);
+
+       wm8994_write(0x02,   0x6110);
+       wm8994_write(0x04,   0x0303);
+       wm8994_write(0x1A,   0x015F);  //volume
+  
+       wm8994_write(0x28,   0x0003);
+       wm8994_write(0x2A,   0x0020);
+       wm8994_write(0x200,  0x0011);
+       wm8994_write(0x208,  0x000A);
+       wm8994_write(0x300,  0xC050);
+       wm8994_write(0x606,  0x0002);
+       wm8994_write(0x607,  0x0002);
+       wm8994_write(0x620,  0x0000);
+
+}
+
+void  FM_to_Headset(void)
+{
+       DBG("Enter::%s----line->%d-- FM_to_Headset\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_FM_to_Headset;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01,  0x0323); 
+       wm8994_write(0x02,  0x03A0);  
+       wm8994_write(0x03,  0x0030);    
+       wm8994_write(0x19,  0x010B);  //LEFT LINE INPUT 3&4 VOLUME      
+       wm8994_write(0x1B,  0x010B);  //RIGHT LINE INPUT 3&4 VOLUME
+
+       wm8994_write(0x28,  0x0044);  
+       wm8994_write(0x29,  0x0100);     
+       wm8994_write(0x2A,  0x0100);
+       wm8994_write(0x2D,  0x0040); 
+       wm8994_write(0x2E,  0x0040);
+       wm8994_write(0x4C,  0x9F25);
+       wm8994_write(0x60,  0x00EE);
+       wm8994_write(0x220, 0x0003);
+       wm8994_write(0x221, 0x0700);
+       wm8994_write(0x224, 0x0CC0);
+       wm8994_write(0x200, 0x0011);    
+       wm8994_write(0x1C,  0x01F9);  //LEFT OUTPUT VOLUME      
+       wm8994_write(0x1D,  0x01F9);  //RIGHT OUTPUT VOLUME
+}
+
+void  FM_to_Headset_and_Record(void)
+{
+       DBG("Enter::%s----line->%d-- FM_to_Headset_and_Record\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_FM_to_Headset_and_Record;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01,   0x0003);  
+       mdelay(50);
+       wm8994_write(0x221,  0x1900);  //8~13BIT div
+
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x302,  0x4000);  // master = 0x4000 // slave= 0x0000
+       wm8994_write(0x303,  0x0040);  // master  0x0050 lrck 7.94kHz bclk 510KHz
+#endif
+       
+       wm8994_write(0x220,  0x0004);
+       mdelay(50);
+       wm8994_write(0x220,  0x0005);  
+
+       wm8994_write(0x01,   0x0323);
+       wm8994_write(0x02,   0x03A0);
+       wm8994_write(0x03,   0x0030);
+       wm8994_write(0x19,   0x010B);  //LEFT LINE INPUT 3&4 VOLUME     
+       wm8994_write(0x1B,   0x010B);  //RIGHT LINE INPUT 3&4 VOLUME
+  
+       wm8994_write(0x28,   0x0044);
+       wm8994_write(0x29,   0x0100);
+       wm8994_write(0x2A,   0x0100);
+       wm8994_write(0x2D,   0x0040);
+       wm8994_write(0x2E,   0x0040);
+       wm8994_write(0x4C,   0x9F25);
+       wm8994_write(0x60,   0x00EE);
+       wm8994_write(0x200,  0x0011);
+       wm8994_write(0x1C,   0x01F9);  //LEFT OUTPUT VOLUME
+       wm8994_write(0x1D,   0x01F9);  //RIGHT OUTPUT VOLUME
+       wm8994_write(0x04,   0x0303);
+       wm8994_write(0x208,  0x000A);
+       wm8994_write(0x300,  0x4050);
+       wm8994_write(0x606,  0x0002);
+       wm8994_write(0x607,  0x0002);
+       wm8994_write(0x620,  0x0000);
+}
+
+void  FM_to_Speakers(void)
+{
+       DBG("Enter::%s----line->%d-- FM_to_Speakers\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_FM_to_Speakers;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01,   0x3023);
+       wm8994_write(0x02,   0x03A0);
+       wm8994_write(0x03,   0x0330);
+       wm8994_write(0x19,   0x010B);  //LEFT LINE INPUT 3&4 VOLUME
+       wm8994_write(0x1B,   0x010B);  //RIGHT LINE INPUT 3&4 VOLUME
+  
+       wm8994_write(0x22,   0x0000);
+       wm8994_write(0x23,   0x0000);
+       wm8994_write(0x36,   0x000C);
+
+       wm8994_write(0x28,   0x0044);
+       wm8994_write(0x29,   0x0100);
+       wm8994_write(0x2A,   0x0100);
+       wm8994_write(0x2D,   0x0040);
+       wm8994_write(0x2E,   0x0040);
+//     wm8994_write(0x4C,   0x9F25);
+//     wm8994_write(0x60,   0x00EE);
+
+       wm8994_write(0x220,  0x0003);
+       wm8994_write(0x221,  0x0700);
+       wm8994_write(0x224,  0x0CC0);
+
+       wm8994_write(0x200,  0x0011);
+       wm8994_write(0x20,   0x01F9);
+       wm8994_write(0x21,   0x01F9);
+}
+
+void  FM_to_Speakers_and_Record(void)
+{
+       DBG("Enter::%s----line->%d-- FM_to_Speakers_and_Record\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_FM_to_Speakers_and_Record;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01,   0x0003);  
+       mdelay(50);
+
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x302,  0x4000);  // master = 0x4000 // slave= 0x0000
+       wm8994_write(0x303,  0x0090);  //
+#endif
+       
+       wm8994_write(0x220,  0x0006);
+       mdelay(50);
+
+       wm8994_write(0x01,   0x3023);
+       wm8994_write(0x02,   0x03A0);
+       wm8994_write(0x03,   0x0330);
+       wm8994_write(0x19,   0x010B);  //LEFT LINE INPUT 3&4 VOLUME
+       wm8994_write(0x1B,   0x010B);  //RIGHT LINE INPUT 3&4 VOLUME
+  
+       wm8994_write(0x22,   0x0000);
+       wm8994_write(0x23,   0x0000);
+       wm8994_write(0x36,   0x000C);
+
+       wm8994_write(0x28,   0x0044);
+       wm8994_write(0x29,   0x0100);
+       wm8994_write(0x2A,   0x0100);
+       wm8994_write(0x2D,   0x0040);
+       wm8994_write(0x2E,   0x0040);
+//     wm8994_write(0x4C,   0x9F25);
+//     wm8994_write(0x60,   0x00EE);
+
+       wm8994_write(0x220,  0x0003);
+       wm8994_write(0x221,  0x0700);
+       wm8994_write(0x224,  0x0CC0);
+
+       wm8994_write(0x200,  0x0011);
+       wm8994_write(0x20,   0x01F9);
+       wm8994_write(0x21,   0x01F9);
+       wm8994_write(0x04,   0x0303);
+       wm8994_write(0x208,  0x000A);   
+       wm8994_write(0x300,  0x4050);
+       wm8994_write(0x606,  0x0002);   
+       wm8994_write(0x607,  0x0002);
+       wm8994_write(0x620,  0x0000);
+}
+
+void  HandsetMIC_to_Baseband_to_Headset(void)
+{
+       DBG("Enter::%s----line->%d-- HandsetMIC_to_Baseband_to_Headset\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_HandsetMIC_to_Baseband_to_Headset;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01,  0x0323); 
+       wm8994_write(0x02,  0x6040); 
+       wm8994_write(0x03,  0x3030); 
+       wm8994_write(0x18,  0x014B);  //mic volume
+       wm8994_write(0x1E,  0x0006); 
+       wm8994_write(0x28,  0x0030); 
+       wm8994_write(0x2D,  0x0002);  //bit 1 IN2LP_TO_MIXOUTL
+       wm8994_write(0x2E,  0x0002);  //bit 1 IN2RP_TO_MIXOUTR
+       wm8994_write(0x34,  0x0002); 
+       wm8994_write(0x4C,  0x9F25); 
+       wm8994_write(0x60,  0x00EE); 
+       wm8994_write(0x220, 0x0003); 
+       wm8994_write(0x221, 0x0700); 
+       wm8994_write(0x224, 0x0CC0); 
+
+//Note: free-running start first, then open AIF1 clock setting
+       wm8994_write(0x200, 0x0011);
+//Note: 0x1C/0x1D=0x01FF-->bypass volume no gain/attenuation
+       wm8994_write(0x1C,  0x01FF);  //LEFT OUTPUT VOLUME
+       wm8994_write(0x1D,  0x01F9);  //RIGHT OUTPUT VOLUME
+}
+
+void  HandsetMIC_to_Baseband_to_Headset_and_Record(void)
+{
+       DBG("Enter::%s----line->%d-- HandsetMIC_to_Baseband_to_Headset_and_Record\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_HandsetMIC_to_Baseband_to_Headset_and_Record;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01,  0x0323); 
+       wm8994_write(0x02,  0x62C0); 
+       wm8994_write(0x03,  0x3030); 
+       wm8994_write(0x04,  0x0303); 
+       wm8994_write(0x18,  0x014B);  //volume
+       wm8994_write(0x19,  0x014B);  //volume
+       wm8994_write(0x1C,  0x01FF);  //LEFT OUTPUT VOLUME
+       wm8994_write(0x1D,  0x01F9);  //RIGHT OUTPUT VOLUME
+       wm8994_write(0x1E,  0x0006); 
+       wm8994_write(0x28,  0x00B0);  //IN2LP_TO_IN2L
+       wm8994_write(0x29,  0x0120); 
+       wm8994_write(0x2D,  0x0002);  //bit 1 IN2LP_TO_MIXOUTL
+       wm8994_write(0x2E,  0x0002);  //bit 1 IN2RP_TO_MIXOUTR
+       wm8994_write(0x34,  0x0002); 
+       wm8994_write(0x4C,  0x9F25); 
+       wm8994_write(0x60,  0x00EE); 
+       wm8994_write(0x200, 0x0001); 
+       wm8994_write(0x208, 0x000A); 
+       wm8994_write(0x300, 0x0050); 
+
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x302, 0x4000);  // master = 0x4000 // slave= 0x0000
+       wm8994_write(0x303, 0x0090);  // master lrck 16k
+#endif
+
+       wm8994_write(0x606, 0x0002); 
+       wm8994_write(0x607, 0x0002); 
+       wm8994_write(0x620, 0x0000); 
+
+       wm8994_write(0x1C, 0x01F9); 
+       wm8994_write(0x1D, 0x01F9); 
+}
+
+void  MainMIC_to_Baseband_to_Earpiece(void)
+{
+       DBG("Enter::%s----line->%d-- MainMIC_to_Baseband_to_Earpiece\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_MainMIC_to_Baseband_to_Earpiece;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01, 0x0813);
+       wm8994_write(0x02, 0x6210);
+       wm8994_write(0x03, 0x30A0);
+       wm8994_write(0x1A, 0x015F);  //main mic volume
+       wm8994_write(0x1E, 0x0006);
+       wm8994_write(0x1F, 0x0000);
+       wm8994_write(0x28, 0x0003);
+       wm8994_write(0x2B, 0x0005);  //VRX_MIXINL_VOL
+       wm8994_write(0x2D, 0x0040);
+       wm8994_write(0x33, 0x0010);
+       wm8994_write(0x34, 0x0004);
+}
+
+void  MainMIC_to_Baseband_to_Earpiece_and_Record(void)
+{
+       DBG("Enter::%s----line->%d-- MainMIC_to_Baseband_to_Earpiece_and_Record\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_MainMIC_to_Baseband_to_Earpiece_and_Record;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01  ,0x0813);
+       wm8994_write(0x02  ,0x6310);
+       wm8994_write(0x03  ,0x30A0);
+       wm8994_write(0x04  ,0x0303);
+       wm8994_write(0x1A  ,0x014F);
+       wm8994_write(0x1E  ,0x0006);
+       wm8994_write(0x1F  ,0x0000);
+       wm8994_write(0x28  ,0x0003);  //MAINMIC_TO_IN1R  //
+       wm8994_write(0x2A  ,0x0020);  //IN1R_TO_MIXINR   //
+       wm8994_write(0x2B  ,0x0005);  //VRX_MIXINL_VOL bit 0~2
+       wm8994_write(0x2C  ,0x0005);  //VRX_MIXINR_VOL
+       wm8994_write(0x2D  ,0x0040);  //MIXINL_TO_MIXOUTL
+       wm8994_write(0x33  ,0x0010);  //MIXOUTLVOL_TO_HPOUT2
+       wm8994_write(0x34  ,0x0004);  //IN1R_TO_LINEOUT1 //
+       wm8994_write(0x200 ,0x0001);
+       wm8994_write(0x208 ,0x000A);
+       wm8994_write(0x300 ,0xC050);
+
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x302, 0x4000);  // master = 0x4000 // slave= 0x0000
+       wm8994_write(0x303, 0x0090);  // master lrck 16k
+#endif
+
+       wm8994_write(0x606 ,0x0002);
+       wm8994_write(0x607 ,0x0002);
+       wm8994_write(0x620 ,0x0000);
+}
+
+void  MainMIC_to_Baseband_to_Speakers(void)
+{
+       DBG("Enter::%s----line->%d-- MainMIC_to_Baseband_to_Speakers\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_MainMIC_to_Baseband_to_Speakers;
+       wm8994_reset();
+       mdelay(50);
+
+#if 1
+       wm8994_write(0x01 ,0x3013);
+       wm8994_write(0x02 ,0x6210);
+       wm8994_write(0x03 ,0x3330);
+       wm8994_write(0x1A ,0x015F);
+       wm8994_write(0x1E ,0x0006);
+       wm8994_write(0x22 ,0x0000);
+       wm8994_write(0x23 ,0x0100);
+       wm8994_write(0x26 ,0x017F);  //Speaker Volume Left bit 0~5
+       wm8994_write(0x27 ,0x017F);  //Speaker Volume Right bit 0~5
+       wm8994_write(0x28 ,0x0003);
+       wm8994_write(0x2D ,0x0002);  //bit 1 IN2LP_TO_MIXOUTL
+       wm8994_write(0x2E ,0x0002);  //bit 1 IN2RP_TO_MIXOUTR
+       wm8994_write(0x34 ,0x0004);   
+       wm8994_write(0x36 ,0x000C);
+#endif
+}
+
+void  MainMIC_to_Baseband_to_Speakers_and_Record(void)
+{
+       DBG("Enter::%s----line->%d-- MainMIC_to_Baseband_to_Speakers_and_Record\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_MainMIC_to_Baseband_to_Speakers_and_Record;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01, 0x3013);
+       wm8994_write(0x02, 0x6330);
+       wm8994_write(0x03, 0x3330);
+       wm8994_write(0x04, 0x0303);
+       wm8994_write(0x1A, 0x014B);
+       wm8994_write(0x1B, 0x014B);
+       wm8994_write(0x1E, 0x0006);
+       wm8994_write(0x22, 0x0000);
+       wm8994_write(0x23, 0x0100);
+       wm8994_write(0x28, 0x0007);
+       wm8994_write(0x2A, 0x0120);
+       wm8994_write(0x2D, 0x0002);  //bit 1 IN2LP_TO_MIXOUTL
+       wm8994_write(0x2E, 0x0002);  //bit 1 IN2RP_TO_MIXOUTR
+       wm8994_write(0x34, 0x0004);
+       wm8994_write(0x36, 0x000C);
+       wm8994_write(0x200, 0x0001);
+       wm8994_write(0x208, 0x000A);
+       wm8994_write(0x300, 0xC050);
+
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x302, 0x4000);  // master = 0x4000 // slave= 0x0000
+       wm8994_write(0x303, 0x0090);  // master lrck 16k
+#endif
+
+       wm8994_write(0x606, 0x0002);
+       wm8994_write(0x607, 0x0002);
+       wm8994_write(0x620, 0x0000);
+
+}
+
+void  BT_Baseband(void)
+{
+       DBG("Enter::%s----line->%d-- BT_Baseband\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_BT_Baseband;
+       wm8994_reset();
+       mdelay(50);
+#if 1
+       wm8994_write(0x01,  0x0003);  
+       mdelay(50);
+       wm8994_write(0x221, 0x0700);  
+       wm8994_write(0x222, 0x3127);    
+       wm8994_write(0x223, 0x0100);    
+       wm8994_write(0x220, 0x0004);
+       mdelay(50);
+       wm8994_write(0x220, 0x0005);
+
+       wm8994_write(0x01,  0x0003);
+       wm8994_write(0x03,  0x30F0);
+       wm8994_write(0x05,  0x3003);
+       wm8994_write(0x2D,  0x0001);
+       wm8994_write(0x2E,  0x0001);
+
+       wm8994_write(0x200, 0x0001); 
+       wm8994_write(0x204, 0x0001);
+       wm8994_write(0x208, 0x0007);
+       wm8994_write(0x520, 0x0000);
+       wm8994_write(0x601, 0x0004);
+       wm8994_write(0x602, 0x0004);
+       wm8994_write(0x610, 0x01C0);
+       wm8994_write(0x611, 0x01C0);
+       wm8994_write(0x613, 0x01C0);
+   
+       wm8994_write(0x702, 0xC100); 
+       wm8994_write(0x703, 0xC100);
+       wm8994_write(0x704, 0xC100);
+       wm8994_write(0x706, 0x4100);
+       
+       wm8994_write(0x204, 0x0011);  // AIF2 MCLK=FLL                            //MASTER
+       wm8994_write(0x211, 0x0039);  //LRCK=8KHZ,Rate=MCLK/1536                         //MASTER
+       wm8994_write(0x310, 0xC118);  //DSP/PCM; 16bits; ADC L channel = R channel;MODE A
+
+       wm8994_write(0x313, 0x00F0);
+       wm8994_write(0x314, 0x0020);    
+       wm8994_write(0x315, 0x0020);            
+       wm8994_write(0x2B,  0x0005);    
+       wm8994_write(0x2C,  0x0005);
+       wm8994_write(0x02,  0x6300);
+       wm8994_write(0x04,  0x3003);
+
+       wm8994_write(0x1E,  0x0006);  //LINEOUT1N_MUTE(001Eh);
+       wm8994_write(0x34,  0x0001);  //LINEOUT1_MODE=1;LINEOUT_VMID_BUF_ENA=1;
+
+       wm8994_write(0x603, 0x018C);     
+       wm8994_write(0x604, 0x0010);
+       wm8994_write(0x605, 0x0010);
+       wm8994_write(0x621, 0x0001);
+       wm8994_write(0x317, 0x0003);
+
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x312, 0x4000);  //set 0x312 PCM2 as Master
+       wm8994_write(0x313, 0x0090);  //master   0x0090 lrck2 8kHz bclk2 1MH
+       wm8994_write(0x315, 0x007D);  //master   0x007D lrck2 8kHz bclk2 1MH
+#endif
+
+#endif
+#if 0
+       wm8994_write(0x01 ,0x0003);
+       wm8994_write(0x02 ,0x63A0); 
+       wm8994_write(0x03 ,0x30A0); 
+       wm8994_write(0x04 ,0x0303); 
+       wm8994_write(0x05 ,0x0202); 
+       wm8994_write(0x06 ,0x0001); 
+       wm8994_write(0x19 ,0x014B); 
+       wm8994_write(0x1B ,0x014B); 
+       wm8994_write(0x1E ,0x0006); 
+       wm8994_write(0x28 ,0x00CC); 
+       wm8994_write(0x29 ,0x0100); 
+       wm8994_write(0x2A ,0x0100); 
+       wm8994_write(0x2D ,0x0001); 
+       wm8994_write(0x34 ,0x0001); 
+       wm8994_write(0x200 ,0x0001);
+       wm8994_write(0x208 ,0x000A);
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x302 ,0x7000);
+#endif
+       wm8994_write(0x303, 0x0090);  //master   0x0090 lrck1 8kHz bclk1 1MH
+       wm8994_write(0x305, 0x007D);  //master   0x007D lrck1 8kHz bclk1 1MH
+
+       wm8994_write(0x420 ,0x0000);
+       wm8994_write(0x601 ,0x0001);
+       wm8994_write(0x602 ,0x0001);
+       wm8994_write(0x606 ,0x0002);
+       wm8994_write(0x607 ,0x0002);
+       wm8994_write(0x610 ,0x01C0);
+       wm8994_write(0x611 ,0x01C0);
+       wm8994_write(0x620 ,0x0000);
+       wm8994_write(0x707 ,0xA100);
+       wm8994_write(0x708 ,0x2100);
+       wm8994_write(0x709 ,0x2100);
+       wm8994_write(0x70A ,0x2100);
+#endif
+}
+
+void  BT_Baseband_and_record(void)
+{
+       DBG("Enter::%s----line->%d-- BT_Baseband_and_record\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_BT_Baseband_and_record;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01, 0x0003);
+       wm8994_write(0x02, 0x63A0);
+       wm8994_write(0x03, 0x30A0);
+       wm8994_write(0x04, 0x3303);
+       wm8994_write(0x05, 0x3002);
+       wm8994_write(0x06, 0x000A);
+       wm8994_write(0x19, 0x014B);
+       wm8994_write(0x1B, 0x014B);
+       wm8994_write(0x1E, 0x0006);
+       wm8994_write(0x28, 0x00CC);
+       wm8994_write(0x29, 0x0100);
+       wm8994_write(0x2A, 0x0100);
+       wm8994_write(0x2D, 0x0001);
+       wm8994_write(0x34, 0x0001);
+       wm8994_write(0x200, 0x0001);
+       wm8994_write(0x204, 0x0001);
+       wm8994_write(0x208, 0x000F);
+
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x312, 0x7000);
+       wm8994_write(0x313, 0x0090);  //master   0x0090 lrck2 8kHz bclk2 1MH
+       wm8994_write(0x315, 0x007D);  //master   0x007D lrck2 8kHz bclk2 1MH
+
+       wm8994_write(0x302, 0x4000);
+       wm8994_write(0x303, 0x0090);  //master  
+#endif 
+
+       wm8994_write(0x440, 0x0018);
+       wm8994_write(0x450, 0x0018);
+       wm8994_write(0x480, 0x0000);
+       wm8994_write(0x481, 0x0000);
+       wm8994_write(0x4A0, 0x0000);
+       wm8994_write(0x4A1, 0x0000);
+       wm8994_write(0x520, 0x0000);
+       wm8994_write(0x540, 0x0018);
+       wm8994_write(0x580, 0x0000);
+       wm8994_write(0x581, 0x0000);
+       wm8994_write(0x601, 0x0004);
+       wm8994_write(0x603, 0x000C);
+       wm8994_write(0x604, 0x0010);
+       wm8994_write(0x605, 0x0010);
+       wm8994_write(0x606, 0x0003);
+       wm8994_write(0x607, 0x0003);
+       wm8994_write(0x610, 0x01C0);
+       wm8994_write(0x612, 0x01C0);
+       wm8994_write(0x613, 0x01C0);
+       wm8994_write(0x620, 0x0000);
+       wm8994_write(0x704, 0xA100);
+       wm8994_write(0x707, 0xA100);
+       wm8994_write(0x708, 0x2100);
+       wm8994_write(0x709, 0x2100);
+       wm8994_write(0x70A, 0x2100);
+}
+
+
+///PCM BB BEGIN////////////////////////////////////
+
+void  HandsetMIC_to_PCMBaseband_to_Headset(void)
+{
+       DBG("Enter::%s----line->%d-- HandsetMIC_to_PCMBaseband_to_Headset\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_HandsetMIC_to_PCMBaseband_to_Headset;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01,  0x0003);  
+       mdelay(50);
+       wm8994_write(0x221, 0x0700);  
+       wm8994_write(0x222, 0x3127);    
+       wm8994_write(0x223, 0x0100);    
+       wm8994_write(0x220, 0x0004);
+       mdelay(50);
+       wm8994_write(0x220, 0x0005);  
+
+       wm8994_write(0x01,  0x0303);  // sysclk = fll (bit4 =1)   0x0011 
+       wm8994_write(0x02,  0x0240);
+       wm8994_write(0x03,  0x0030);
+       wm8994_write(0x04,  0x3003);
+       wm8994_write(0x05,  0x3003);  // i2s 16 bits
+       wm8994_write(0x18,  0x010B);
+       wm8994_write(0x28,  0x0030);
+       wm8994_write(0x29,  0x0020);
+       wm8994_write(0x2D,  0x0100);
+       wm8994_write(0x2E,  0x0100);
+       wm8994_write(0x4C,  0x9F25);
+       wm8994_write(0x60,  0x00EE);
+       wm8994_write(0x200, 0x0001);
+       wm8994_write(0x204, 0x0001);
+       wm8994_write(0x208, 0x0007);
+       wm8994_write(0x520, 0x0000);
+       wm8994_write(0x601, 0x0004);
+       wm8994_write(0x602, 0x0004);
+
+       wm8994_write(0x610, 0x01C0);
+       wm8994_write(0x611, 0x01C0);
+       wm8994_write(0x612, 0x01C0);
+       wm8994_write(0x613, 0x01C0);
+
+       wm8994_write(0x702, 0xC100);
+       wm8994_write(0x703, 0xC100);
+       wm8994_write(0x704, 0xC100);
+       wm8994_write(0x706, 0x4100);
+       wm8994_write(0x204, 0x0011);
+       wm8994_write(0x211, 0x0009);
+       wm8994_write(0x310, 0x4118);
+       wm8994_write(0x313, 0x00F0);
+       wm8994_write(0x314, 0x0020);
+       wm8994_write(0x315, 0x0020);
+
+       wm8994_write(0x603, 0x018C);  //Rev.D ADCL SideTone
+       wm8994_write(0x604, 0x0010);
+       wm8994_write(0x605, 0x0010);
+       wm8994_write(0x621, 0x0001);
+//     wm8994_write(0x317, 0x0003);
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x312, 0x4000);  //AIF2 SET AS MASTER
+#endif
+}
+
+void  HandsetMIC_to_PCMBaseband_to_Headset_and_Record(void)
+{
+       DBG("Enter::%s----line->%d-- HandsetMIC_to_PCMBaseband_to_Headset_and_Record\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_HandsetMIC_to_PCMBaseband_to_Headset_and_Record;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01,  0x0003);  
+       mdelay(50);
+       wm8994_write(0x221, 0x0700);  //MCLK=12MHz
+       wm8994_write(0x222, 0x3127);    
+       wm8994_write(0x223, 0x0100);    
+       wm8994_write(0x220, 0x0004);
+       mdelay(50);
+       wm8994_write(0x220, 0x0005);  
+
+       wm8994_write(0x01,  0x0303);     
+       wm8994_write(0x02,  0x0240);
+       wm8994_write(0x03,  0x0030);
+       wm8994_write(0x04,  0x3003);
+       wm8994_write(0x05,  0x3003); 
+       wm8994_write(0x18,  0x010B);  // 0x011F=+30dB for MIC
+       wm8994_write(0x28,  0x0030);
+       wm8994_write(0x29,  0x0020);
+       wm8994_write(0x2D,  0x0100);
+       wm8994_write(0x2E,  0x0100);
+       wm8994_write(0x4C,  0x9F25);
+       wm8994_write(0x60,  0x00EE);
+       wm8994_write(0x200, 0x0001);    
+       wm8994_write(0x204, 0x0001);
+       wm8994_write(0x208, 0x0007);    
+       wm8994_write(0x520, 0x0000);    
+       wm8994_write(0x601, 0x0004);
+       wm8994_write(0x602, 0x0004);
+
+       wm8994_write(0x610, 0x01C0);            
+       wm8994_write(0x611, 0x01C0);
+       wm8994_write(0x612, 0x01C0);            
+       wm8994_write(0x613, 0x01C0);
+
+       wm8994_write(0x700, 0x8141);  //SYNC issue, AIF1 ADCLRC1 from LRCK1
+       wm8994_write(0x702, 0xC100);
+       wm8994_write(0x703, 0xC100);
+       wm8994_write(0x704, 0xC100);
+       wm8994_write(0x706, 0x4100);
+       wm8994_write(0x204, 0x0011);  //AIF2 MCLK=FLL1
+       wm8994_write(0x211, 0x0009);  //LRCK=8KHz, Rate=MCLK/1536
+       wm8994_write(0x310, 0x4118);  //DSP/PCM 16bits
+       wm8994_write(0x313, 0x00F0);
+       wm8994_write(0x314, 0x0020);
+       wm8994_write(0x315, 0x0020);
+
+       wm8994_write(0x603, 0x000C);  //Rev.D ADCL SideTone
+       wm8994_write(0x604, 0x0010);
+       wm8994_write(0x605, 0x0010);
+       wm8994_write(0x621, 0x0000);
+//     wm8994_write(0x317, 0x0003);
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x312, 0x4000);  //AIF2 SET AS MASTER
+#endif
+////AIF1
+       wm8994_write(0x04,   0x3303);
+       wm8994_write(0x200,  0x0001);
+       wm8994_write(0x208,  0x000F);
+       wm8994_write(0x210,  0x0009);  //LRCK=8KHz, Rate=MCLK/1536
+       wm8994_write(0x300,  0x0118);  //DSP/PCM 16bits, R ADC = L ADC 
+       wm8994_write(0x606,  0x0003);   
+       wm8994_write(0x607,  0x0003);
+
+////AIF1 Master Clock(SR=8KHz)
+       wm8994_write(0x200,  0x0011);
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x302,  0x4000);
+#endif
+       wm8994_write(0x303,  0x00F0);
+       wm8994_write(0x304,  0x0020);
+       wm8994_write(0x305,  0x0020);
+
+////AIF1 DAC1 HP
+       wm8994_write(0x05,   0x3303);
+       wm8994_write(0x420,  0x0000);
+       wm8994_write(0x601,  0x0001);
+       wm8994_write(0x602,  0x0001);
+       wm8994_write(0x700,  0x8140);  //SYNC issue, AIF1 ADCLRC1 from FLL after AIF1 MASTER!!!
+}
+
+void  MainMIC_to_PCMBaseband_to_Earpiece(void)
+{
+       DBG("Enter::%s----line->%d-- MainMIC_to_PCMBaseband_to_Earpiece\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_MainMIC_to_PCMBaseband_to_Earpiece;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01,  0x0013);  
+       mdelay(50);
+       wm8994_write(0x221, 0x0700);  //MCLK=12MHz
+       wm8994_write(0x222, 0x3127);    
+       wm8994_write(0x223, 0x0100);    
+       wm8994_write(0x220, 0x0004);
+       mdelay(50);
+       wm8994_write(0x220, 0x0005);  
+
+       wm8994_write(0x01,  0x0813);     
+       wm8994_write(0x02,  0x0110);
+       wm8994_write(0x03,  0x00F0);
+       wm8994_write(0x04,  0x3003);
+       wm8994_write(0x05,  0x3003); 
+       wm8994_write(0x1A,  0x010B); 
+       wm8994_write(0x1F,  0x0000); 
+       wm8994_write(0x28,  0x0003);
+       wm8994_write(0x2A,  0x0020);
+       wm8994_write(0x2D,  0x0001);
+       wm8994_write(0x2E,  0x0001);
+       wm8994_write(0x33,  0x0018);
+//     wm8994_write(0x4C,  0x9F25);
+//     wm8994_write(0x60,  0x00EE);
+       wm8994_write(0x200, 0x0001);
+       wm8994_write(0x204, 0x0001);
+       wm8994_write(0x208, 0x0007);
+       wm8994_write(0x520, 0x0000);
+       wm8994_write(0x601, 0x0004);
+       wm8994_write(0x602, 0x0004);
+
+       wm8994_write(0x610, 0x01C0);
+       wm8994_write(0x611, 0x01C0);
+       wm8994_write(0x612, 0x01C0);
+       wm8994_write(0x613, 0x01C0);
+
+       wm8994_write(0x700, 0x8141);
+       wm8994_write(0x702, 0xC100);
+       wm8994_write(0x703, 0xC100);
+       wm8994_write(0x704, 0xC100);
+       wm8994_write(0x706, 0x4100);
+       wm8994_write(0x204, 0x0011);  //AIF2 MCLK=FLL1
+       wm8994_write(0x211, 0x0009);  //LRCK=8KHz, Rate=MCLK/1536
+       wm8994_write(0x310, 0x4118);  //DSP/PCM 16bits
+       wm8994_write(0x313, 0x00F0);
+       wm8994_write(0x314, 0x0020);
+       wm8994_write(0x315, 0x0020);
+
+       wm8994_write(0x603, 0x018C);  //Rev.D ADCL SideTone
+       wm8994_write(0x604, 0x0010);
+       wm8994_write(0x605, 0x0010);
+       wm8994_write(0x621, 0x0001);
+//     wm8994_write(0x317, 0x0003);
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x312, 0x4000);  //AIF2 SET AS MASTER
+#endif
+}
+
+void  MainMIC_to_PCMBaseband_to_Earpiece_and_Record(void)
+{
+       DBG("Enter::%s----line->%d-- MainMIC_to_PCMBaseband_to_Earpiece_and_Record\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_MainMIC_to_PCMBaseband_to_Earpiece_and_Record;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01,  0x0013);  
+       mdelay(50);
+       wm8994_write(0x221, 0x0700);  //MCLK=12MHz
+       wm8994_write(0x222, 0x3127);    
+       wm8994_write(0x223, 0x0100);    
+       wm8994_write(0x220, 0x0004);
+       mdelay(50);
+       wm8994_write(0x220, 0x0005);  
+
+       wm8994_write(0x01,  0x0813);     
+       wm8994_write(0x02,  0x0110);
+       wm8994_write(0x03,  0x00F0);
+       wm8994_write(0x04,  0x3003);
+       wm8994_write(0x05,  0x3003); 
+       wm8994_write(0x1A,  0x010B); 
+       wm8994_write(0x1F,  0x0000); 
+       wm8994_write(0x28,  0x0003);
+       wm8994_write(0x2A,  0x0020);
+       wm8994_write(0x2D,  0x0001);
+       wm8994_write(0x2E,  0x0001);
+       wm8994_write(0x33,  0x0018);
+//     wm8994_write(0x4C,  0x9F25);
+//     wm8994_write(0x60,  0x00EE);
+       wm8994_write(0x200, 0x0001);    
+       wm8994_write(0x204, 0x0001);
+       wm8994_write(0x208, 0x0007);    
+       wm8994_write(0x520, 0x0000);    
+       wm8994_write(0x601, 0x0004);
+       wm8994_write(0x602, 0x0004);
+
+       wm8994_write(0x610, 0x01C0);            
+       wm8994_write(0x611, 0x01C0);
+       wm8994_write(0x612, 0x01C0);            
+       wm8994_write(0x613, 0x01C0);
+
+       wm8994_write(0x702, 0xC100);
+       wm8994_write(0x703, 0xC100);
+       wm8994_write(0x704, 0xC100);
+       wm8994_write(0x706, 0x4100);
+       wm8994_write(0x204, 0x0011);  //AIF2 MCLK=FLL1
+       wm8994_write(0x211, 0x0009);  //LRCK=8KHz, Rate=MCLK/1536
+       wm8994_write(0x310, 0x4118);  //DSP/PCM 16bits
+       wm8994_write(0x313, 0x00F0);
+       wm8994_write(0x314, 0x0020);
+       wm8994_write(0x315, 0x0020);
+
+       wm8994_write(0x603, 0x018C);  //Rev.D ADCL SideTone
+       wm8994_write(0x604, 0x0010);
+       wm8994_write(0x605, 0x0010);
+       wm8994_write(0x621, 0x0001);
+//     wm8994_write(0x317, 0x0003);
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x312, 0x4000);  //AIF2 SET AS MASTER
+#endif
+
+////AIF1
+       wm8994_write(0x04,   0x3303);
+       wm8994_write(0x200,  0x0001);
+       wm8994_write(0x208,  0x000F);
+       wm8994_write(0x210,  0x0009);  //LRCK=8KHz, Rate=MCLK/1536
+       wm8994_write(0x300,  0xC118);  //DSP/PCM 16bits, R ADC = L ADC 
+       wm8994_write(0x606,  0x0003);   
+       wm8994_write(0x607,  0x0003);
+
+////AIF1 Master Clock(SR=8KHz)
+       wm8994_write(0x200,  0x0011);
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x302,  0x4000);
+#endif
+       wm8994_write(0x303,  0x00F0);
+       wm8994_write(0x304,  0x0020);
+       wm8994_write(0x305,  0x0020);
+
+////AIF1 DAC1 HP
+       wm8994_write(0x05,   0x3303);
+       wm8994_write(0x420,  0x0000);
+       wm8994_write(0x601,  0x0001);
+       wm8994_write(0x602,  0x0001);
+       wm8994_write(0x700,  0x8140);//SYNC issue, AIF1 ADCLRC1 from FLL after AIF1 MASTER!!!
+}
+
+void  MainMIC_to_PCMBaseband_to_Speakers(void)
+{
+       DBG("Enter::%s----line->%d-- MainMIC_to_PCMBaseband_to_Speakers\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_MainMIC_to_PCMBaseband_to_Speakers;
+       wm8994_reset();
+       mdelay(50);
+#if 1
+       wm8994_write(0x01,  0x0013);  
+       mdelay(50);
+       wm8994_write(0x221, 0x0700);  //MCLK=12MHz   //FLL1 CONTRLO(2)
+       wm8994_write(0x222, 0x3127);  //FLL1 CONTRLO(3) 
+       wm8994_write(0x223, 0x0100);  //FLL1 CONTRLO(4) 
+       wm8994_write(0x220, 0x0004);  //FLL1 CONTRLO(1)
+       mdelay(50);
+       wm8994_write(0x220, 0x0005);  //FLL1 CONTRLO(1)
+
+       wm8994_write(0x01,  0x3013);     
+       wm8994_write(0x02,  0x0110);
+       wm8994_write(0x03,  0x0330);
+       wm8994_write(0x04,  0x3003);
+       wm8994_write(0x05,  0x3003); 
+       wm8994_write(0x1A,  0x011F);
+       wm8994_write(0x22,  0x0000);
+       wm8994_write(0x23,  0x0000);
+       wm8994_write(0x28,  0x0003);
+       wm8994_write(0x2A,  0x0020);
+       wm8994_write(0x2D,  0x0001);
+       wm8994_write(0x2E,  0x0001);
+       wm8994_write(0x36,  0x000C);  //MIXOUTL_TO_SPKMIXL  MIXOUTR_TO_SPKMIXR
+//     wm8994_write(0x4C,  0x9F25);
+//     wm8994_write(0x60,  0x00EE);
+       wm8994_write(0x200, 0x0001);  //AIF1 CLOCKING(1)
+       wm8994_write(0x204, 0x0001);  //AIF2 CLOCKING(1)
+       wm8994_write(0x208, 0x0007);  //CLOCKING(1)
+       wm8994_write(0x520, 0x0000);  //AIF2 DAC FILTERS(1)
+       wm8994_write(0x601, 0x0004);  //AIF2DACL_DAC1L
+       wm8994_write(0x602, 0x0004);  //AIF2DACR_DAC1R
+
+       wm8994_write(0x610, 0x01C0);  //DAC1L_VOLUME
+       wm8994_write(0x611, 0x01C0);  //DAC1R_VOLUME
+       wm8994_write(0x612, 0x01C0);  //DAC2L_VOLUME
+       wm8994_write(0x613, 0x01C0);  //DAC2R_VOLUME
+
+       wm8994_write(0x702, 0xC100);  //GPIO3
+       wm8994_write(0x703, 0xC100);  //GPIO4
+       wm8994_write(0x704, 0xC100);  //GPIO5
+       wm8994_write(0x706, 0x4100);  //GPIO7
+       wm8994_write(0x204, 0x0011);  //AIF2 MCLK=FLL1
+       wm8994_write(0x211, 0x0009);  //LRCK=8KHz, Rate=MCLK/1536
+       wm8994_write(0x310, 0x4118);  //DSP/PCM 16bits
+       wm8994_write(0x313, 0x00F0);  //AIF2BCLK
+       wm8994_write(0x314, 0x0020);  //AIF2ADCLRCK
+       wm8994_write(0x315, 0x0020);  //AIF2DACLRCLK
+
+       wm8994_write(0x603, 0x018C);  //Rev.D ADCL SideTone
+       wm8994_write(0x604, 0x0010);  //ADC2_TO_DAC2L
+       wm8994_write(0x605, 0x0010);  //ADC2_TO_DAC2R
+       wm8994_write(0x621, 0x0001);
+//     wm8994_write(0x317, 0x0003);
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x312, 0x4000);  //AIF2 SET AS MASTER
+#endif
+#endif
+}
+
+void  MainMIC_to_PCMBaseband_to_Speakers_and_Record(void)
+{
+       DBG("Enter::%s----line->%d-- MainMIC_to_PCMBaseband_to_Speakers_and_Record\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_MainMIC_to_PCMBaseband_to_Speakers_and_Record;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01,  0x0013);  
+       mdelay(50);
+       wm8994_write(0x221, 0x0700);  //MCLK=12MHz
+       wm8994_write(0x222, 0x3127);    
+       wm8994_write(0x223, 0x0100);    
+       wm8994_write(0x220, 0x0004);
+       mdelay(50);
+       wm8994_write(0x220, 0x0005);  
+
+       wm8994_write(0x01,  0x3013);     
+       wm8994_write(0x02,  0x0110);
+       wm8994_write(0x03,  0x0330);
+       wm8994_write(0x04,  0x3003);
+       wm8994_write(0x05,  0x3003); 
+       wm8994_write(0x1A,  0x010B); 
+       wm8994_write(0x22,  0x0000);
+       wm8994_write(0x23,  0x0000);
+       wm8994_write(0x28,  0x0003);
+       wm8994_write(0x2A,  0x0020);
+       wm8994_write(0x2D,  0x0001);
+       wm8994_write(0x2E,  0x0001);
+       wm8994_write(0x36,  0x000C);
+//     wm8994_write(0x4C,  0x9F25);
+//     wm8994_write(0x60,  0x00EE);
+       wm8994_write(0x200, 0x0001);    
+       wm8994_write(0x204, 0x0001);
+       wm8994_write(0x208, 0x0007);    
+       wm8994_write(0x520, 0x0000);    
+       wm8994_write(0x601, 0x0004);
+       wm8994_write(0x602, 0x0004);
+
+       wm8994_write(0x610, 0x01C0);            
+       wm8994_write(0x611, 0x01C0);
+       wm8994_write(0x612, 0x01C0);            
+       wm8994_write(0x613, 0x01C0);
+
+       wm8994_write(0x700, 0x8141);
+       wm8994_write(0x702, 0xC100);
+       wm8994_write(0x703, 0xC100);
+       wm8994_write(0x704, 0xC100);
+       wm8994_write(0x706, 0x4100);
+       wm8994_write(0x204, 0x0011);  //AIF2 MCLK=FLL1
+       wm8994_write(0x211, 0x0009);  //LRCK=8KHz, Rate=MCLK/1536
+       wm8994_write(0x310, 0x4118);  //DSP/PCM 16bits
+       wm8994_write(0x313, 0x00F0);
+       wm8994_write(0x314, 0x0020);
+       wm8994_write(0x315, 0x0020);
+
+       wm8994_write(0x603, 0x018C);  //Rev.D ADCL SideTone
+       wm8994_write(0x604, 0x0010);
+       wm8994_write(0x605, 0x0010);
+       wm8994_write(0x621, 0x0001);
+//     wm8994_write(0x317, 0x0003);
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x312, 0x4000);  //AIF2 SET AS MASTER
+#endif
+
+////AIF1
+       wm8994_write(0x04,   0x3303);
+       wm8994_write(0x200,  0x0001);
+       wm8994_write(0x208,  0x000F);
+       wm8994_write(0x210,  0x0009);  //LRCK=8KHz, Rate=MCLK/1536
+       wm8994_write(0x300,  0xC118);  //DSP/PCM 16bits, R ADC = L ADC 
+       wm8994_write(0x606,  0x0003);   
+       wm8994_write(0x607,  0x0003);
+
+////AIF1 Master Clock(SR=8KHz)
+       wm8994_write(0x200,  0x0011);
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x302,  0x4000);
+#endif
+       wm8994_write(0x303,  0x00F0);
+       wm8994_write(0x304,  0x0020);
+       wm8994_write(0x305,  0x0020);
+
+////AIF1 DAC1 HP
+       wm8994_write(0x05,   0x3303);
+       wm8994_write(0x420,  0x0000);
+       wm8994_write(0x601,  0x0001);
+       wm8994_write(0x602,  0x0001);
+       wm8994_write(0x700,  0x8140);  //SYNC issue, AIF1 ADCLRC1 from FLL after AIF1 MASTER!!!
+}
+
+void  BT_PCMBaseband(void)
+{
+       DBG("Enter::%s----line->%d-- BT_PCMBaseband\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_BT_PCMBaseband;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01  ,0x0003);
+       mdelay (50);
+
+       wm8994_write(0x200 ,0x0001);
+       wm8994_write(0x221 ,0x0700);  //MCLK=12MHz
+       wm8994_write(0x222 ,0x3127);
+       wm8994_write(0x223 ,0x0100);
+       wm8994_write(0x220 ,0x0004);
+       mdelay (50);
+       wm8994_write(0x220 ,0x0005); 
+
+       wm8994_write(0x02  ,0x0000); 
+       wm8994_write(0x200 ,0x0011);  // AIF1 MCLK=FLL1
+       wm8994_write(0x210 ,0x0009);  // LRCK=8KHz, Rate=MCLK/1536
+       wm8994_write(0x300 ,0x4018);  // DSP/PCM 16bits
+
+       wm8994_write(0x204 ,0x0011);  // AIF2 MCLK=FLL1
+       wm8994_write(0x211 ,0x0009);  // LRCK=8KHz, Rate=MCLK/1536
+       wm8994_write(0x310 ,0x4118);  // DSP/PCM 16bits
+       wm8994_write(0x208 ,0x000F); 
+
+/////AIF1
+       wm8994_write(0x700 ,0x8101);
+/////AIF2
+       wm8994_write(0x702 ,0xC100);
+       wm8994_write(0x703 ,0xC100);
+       wm8994_write(0x704 ,0xC100);
+       wm8994_write(0x706 ,0x4100);
+/////AIF3
+       wm8994_write(0x707 ,0xA100); 
+       wm8994_write(0x708 ,0xA100);
+       wm8994_write(0x709 ,0xA100); 
+       wm8994_write(0x70A ,0xA100);
+
+       wm8994_write(0x06 ,0x0001);
+
+       wm8994_write(0x02 ,0x0300);
+       wm8994_write(0x03 ,0x0030);
+       wm8994_write(0x04 ,0x3301);  //ADCL off
+       wm8994_write(0x05 ,0x3301);  //DACL off
+
+//     wm8994_write(0x29 ,0x0005);  
+       wm8994_write(0x2A ,0x0005);
+
+       wm8994_write(0x313 ,0x00F0);
+       wm8994_write(0x314 ,0x0020);
+       wm8994_write(0x315 ,0x0020);
+
+//     wm8994_write(0x2D  ,0x0001);
+       wm8994_write(0x2E  ,0x0001);
+       wm8994_write(0x420 ,0x0000);
+       wm8994_write(0x520 ,0x0000);
+//     wm8994_write(0x601 ,0x0001);
+       wm8994_write(0x602 ,0x0001);
+       wm8994_write(0x604 ,0x0001);
+       wm8994_write(0x605 ,0x0001);
+//     wm8994_write(0x606 ,0x0002);
+       wm8994_write(0x607 ,0x0002);
+//     wm8994_write(0x610 ,0x01C0);
+       wm8994_write(0x611 ,0x01C0);
+       wm8994_write(0x612 ,0x01C0);
+       wm8994_write(0x613 ,0x01C0);
+
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x312 ,0x4000);
+#endif
+
+       wm8994_write(0x606 ,0x0001);
+       wm8994_write(0x607 ,0x0003);  //R channel for data mix/CPU record data
+
+////////////HP output test
+       wm8994_write(0x01  ,0x0303);
+       wm8994_write(0x4C  ,0x9F25);
+       wm8994_write(0x60  ,0x00EE);
+///////////end HP test
+}
+
+void  BT_PCMBaseband_and_record(void)
+{
+       DBG("Enter::%s----line->%d-- BT_PCMBaseband_and_record\n",__FUNCTION__,__LINE__);
+       wm8994_mode=wm8994_BT_PCMBaseband_and_record;
+       wm8994_reset();
+       mdelay(50);
+
+       wm8994_write(0x01  ,0x0003);
+       mdelay (50);
+
+       wm8994_write(0x200 ,0x0001);
+       wm8994_write(0x221 ,0x0700);  //MCLK=12MHz
+       wm8994_write(0x222 ,0x3127);
+       wm8994_write(0x223 ,0x0100);
+       wm8994_write(0x220 ,0x0004);
+       mdelay (50);
+       wm8994_write(0x220 ,0x0005); 
+
+       wm8994_write(0x02  ,0x0000); 
+       wm8994_write(0x200 ,0x0011);  // AIF1 MCLK=FLL1
+       wm8994_write(0x210 ,0x0009);  // LRCK=8KHz, Rate=MCLK/1536
+       wm8994_write(0x300 ,0x4018);  // DSP/PCM 16bits
+
+       wm8994_write(0x204 ,0x0011);  // AIF2 MCLK=FLL1
+       wm8994_write(0x211 ,0x0009);  // LRCK=8KHz, Rate=MCLK/1536
+       wm8994_write(0x310 ,0x4118);  // DSP/PCM 16bits
+       wm8994_write(0x208 ,0x000F); 
+
+/////AIF1
+       wm8994_write(0x700 ,0x8101);
+/////AIF2
+       wm8994_write(0x702 ,0xC100);
+       wm8994_write(0x703 ,0xC100);
+       wm8994_write(0x704 ,0xC100);
+       wm8994_write(0x706 ,0x4100);
+/////AIF3
+       wm8994_write(0x707 ,0xA100); 
+       wm8994_write(0x708 ,0xA100);
+       wm8994_write(0x709 ,0xA100); 
+       wm8994_write(0x70A ,0xA100);
+
+       wm8994_write(0x06  ,0x0001);
+
+       wm8994_write(0x02  ,0x0300);
+       wm8994_write(0x03  ,0x0030);
+       wm8994_write(0x04  ,0x3301);  //ADCL off
+       wm8994_write(0x05  ,0x3301);  //DACL off
+
+//     wm8994_write(0x29  ,0x0005);  
+       wm8994_write(0x2A  ,0x0005);
+
+       wm8994_write(0x313 ,0x00F0);
+       wm8994_write(0x314 ,0x0020);
+       wm8994_write(0x315 ,0x0020);
+
+//     wm8994_write(0x2D  ,0x0001);
+       wm8994_write(0x2E  ,0x0001);
+       wm8994_write(0x420 ,0x0000);
+       wm8994_write(0x520 ,0x0000);
+//     wm8994_write(0x601 ,0x0001);
+       wm8994_write(0x602 ,0x0001);
+       wm8994_write(0x604 ,0x0001);
+       wm8994_write(0x605 ,0x0001);
+//     wm8994_write(0x606 ,0x0002);
+       wm8994_write(0x607 ,0x0002);
+//     wm8994_write(0x610 ,0x01C0);
+       wm8994_write(0x611 ,0x01C0);
+       wm8994_write(0x612 ,0x01C0);
+       wm8994_write(0x613 ,0x01C0);
+
+#ifdef CONFIG_SND_CODEC_SOC_MASTER
+       wm8994_write(0x312 ,0x4000);
+#endif
+
+       wm8994_write(0x606 ,0x0001);
+       wm8994_write(0x607 ,0x0003);  //R channel for data mix/CPU record data
+
+////////////HP output test
+       wm8994_write(0x01  ,0x0303);
+       wm8994_write(0x4C  ,0x9F25); 
+       wm8994_write(0x60  ,0x00EE); 
+///////////end HP test
+}
+
+
+typedef void (wm8994_codec_fnc_t) (void);
+
+wm8994_codec_fnc_t *wm8994_codec_sequence[] = {
+       AP_to_Headset,
+       AP_to_Speakers,
+       Recorder,
+       FM_to_Headset,
+       FM_to_Headset_and_Record,
+       FM_to_Speakers,
+       FM_to_Speakers_and_Record,
+       HandsetMIC_to_Baseband_to_Headset,
+       HandsetMIC_to_Baseband_to_Headset_and_Record,
+       MainMIC_to_Baseband_to_Earpiece,
+       MainMIC_to_Baseband_to_Earpiece_and_Record,
+       MainMIC_to_Baseband_to_Speakers,
+       MainMIC_to_Baseband_to_Speakers_and_Record,
+       BT_Baseband,
+       BT_Baseband_and_record,
+///PCM BB BEGIN
+       HandsetMIC_to_PCMBaseband_to_Headset,
+       HandsetMIC_to_PCMBaseband_to_Headset_and_Record, 
+       MainMIC_to_PCMBaseband_to_Earpiece,
+       MainMIC_to_PCMBaseband_to_Earpiece_and_Record,
+       MainMIC_to_PCMBaseband_to_Speakers,
+       MainMIC_to_PCMBaseband_to_Speakers_and_Record,
+       BT_PCMBaseband,
+       BT_PCMBaseband_and_record
+///PCM BB END
+};
+
+/********************set wm8994 volume*****volume=0\1\2\3\4\5\6\7*******************/
+
+unsigned char Handset_maxvol=0x3f,VRX_maxvol=0x07,Speaker_maxvol=0x3f,AP_maxvol=0xff,Recorder_maxvol=0x1f,FM_maxvol=0x1f;
+
+void wm8994_codec_set_volume(unsigned char mode,unsigned char volume)
+{
+       unsigned short lvol=0,rvol=0;
+
+       if(wm8994_mode==wm8994_HandsetMIC_to_Baseband_to_Headset_and_Record||
+       wm8994_mode==wm8994_HandsetMIC_to_Baseband_to_Headset)
+       {
+               wm8994_read(0x001c, &lvol);
+               wm8994_read(0x001d, &rvol);
+               wm8994_write(0x001c ,(0x0100|(lvol&0xffc0))|(0x003f&(Handset_maxvol*volume/7)));//bit 0~5  -57dB~6dB
+               wm8994_write(0x001d ,(0x0100|(rvol&0xffc0))|(0x003f&(Handset_maxvol*volume/7)));//bit 0~5 / -57dB~6dB
+       }
+       else if(wm8994_mode==wm8994_BT_Baseband_and_record||wm8994_mode==wm8994_BT_Baseband||
+       wm8994_mode==wm8994_MainMIC_to_Baseband_to_Earpiece_and_Record||
+       wm8994_mode==wm8994_MainMIC_to_Baseband_to_Earpiece)
+       {
+               wm8994_read(0x002b, &lvol);
+               wm8994_write(0x002b ,(0x0100|(lvol&0xfff8))|(0x0007&(VRX_maxvol*volume/7))); //bit 0~2 / -12dB~6dB
+       }
+       else if(wm8994_mode==wm8994_MainMIC_to_Baseband_to_Speakers_and_Record||
+       wm8994_mode==wm8994_MainMIC_to_Baseband_to_Speakers)
+       {
+               wm8994_read(0x0026, &lvol);
+               wm8994_write(0x0026 ,(0x0100|(lvol&0xffc0))|(0x003f&(Speaker_maxvol*volume/7))); //bit0~5 / -57dB~6dB
+       }
+       else if(wm8994_mode==wm8994_AP_to_Headset||wm8994_mode==wm8994_AP_to_Speakers)
+       {
+               wm8994_read(0x0610, &lvol);
+               wm8994_read(0x0611, &rvol);
+               wm8994_write(0x0610 ,(0x0100|(lvol&0xff00))|(0x00ff&(AP_maxvol*volume/7))); //bit 0~7 / -71.625dB~0dB
+               wm8994_write(0x0611 ,(0x0100|(rvol&0xff00))|(0x00ff&(AP_maxvol*volume/7))); //bit 0~7 / -71.625dB~0dB
+       }
+       else if(wm8994_mode==wm8994_Recorder)
+       {
+               wm8994_read(0x001a, &lvol);
+               wm8994_write(0x001a ,(0x0100|(lvol&0xffe0))|(0x001f&(Recorder_maxvol*volume/7))); //bit 0~4 / -16.5dB~30dB
+       }
+       else if(wm8994_mode==wm8994_FM_to_Headset||wm8994_mode==wm8994_FM_to_Headset_and_Record||
+       wm8994_mode==wm8994_FM_to_Speakers||wm8994_mode==wm8994_FM_to_Speakers_and_Record)
+       {
+               wm8994_read(0x0019, &lvol);
+               wm8994_read(0x001b, &rvol);
+               wm8994_write(0x0019 ,(0x0100|(lvol&0xffe0))|(0x001f&(FM_maxvol*volume/7))); //bit 0~4 / -16.5dB~30dB
+               wm8994_write(0x001b ,(0x0100|(rvol&0xffe0))|(0x001f&(FM_maxvol*volume/7))); //bit 0~4 / -16.5dB~30dB
+       }
+}
+
+
+#define SOC_DOUBLE_SWITCH_WM8994CODEC(xname, route) \
+{      .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), \
+       .info = snd_soc_info_route, \
+       .get = snd_soc_get_route, .put = snd_soc_put_route, \
+       .private_value = route }
+
+int snd_soc_info_route(struct snd_kcontrol *kcontrol,
+       struct snd_ctl_elem_info *uinfo)
+{
+       
+       //uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
+       uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
+
+       uinfo->count = 1;
+       uinfo->value.integer.min = 0;
+       uinfo->value.integer.max = 0;
+       return 0;
+}
+
+int snd_soc_get_route(struct snd_kcontrol *kcontrol,
+       struct snd_ctl_elem_value *ucontrol)
+{
+       DBG("@@@Enter::%s----line->%d\n",__FUNCTION__,__LINE__);
+       return 0;
+}
+
+int snd_soc_put_route(struct snd_kcontrol *kcontrol,
+       struct snd_ctl_elem_value *ucontrol)
+{      
+       
+       DBG("@@@Enter::%s----line->%d\n",__FUNCTION__,__LINE__);
+       int route = kcontrol->private_value & 0xff;
+
+       switch(route)
+       {
+               /* Speaker*/
+               case SPEAKER_NORMAL: //AP-> 8994Codec -> Speaker
+#ifndef WM8994_TEST
+                   AP_to_Speakers();
+#endif
+                   break;
+               case SPEAKER_INCALL: //BB-> 8994Codec -> Speaker
+                   MainMIC_to_Baseband_to_Speakers();
+                   break;              
+                       
+               /* Headset */   
+               case HEADSET_NORMAL:    //AP-> 8994Codec -> Headset
+                   AP_to_Headset();
+                   break;
+               case HEADSET_INCALL:    //AP-> 8994Codec -> Headset
+                   HandsetMIC_to_Baseband_to_Headset();
+                   break;                  
+
+               /* Earpiece*/                       
+               case EARPIECE_INCALL:   //:BB-> 8994Codec -> EARPIECE
+                   MainMIC_to_Baseband_to_Earpiece();
+                   break;              
+
+               /* BLUETOOTH_SCO*/                      
+               case BLUETOOTH_SCO_INCALL:      //BB-> 8994Codec -> BLUETOOTH_SCO  
+                   BT_Baseband();
+                   break;
+
+               /* BLUETOOTH_A2DP*/                         
+               case BLUETOOTH_A2DP_NORMAL:     //AP-> 8994Codec -> BLUETOOTH_A2DP
+                   break;
+                   
+               case MIC_CAPTURE:  //
+                   Recorder();
+                   break;
+               default:
+                   //codec_daout_route();
+                   break;
+       }
+       return 0;
+}
+
+/*
+ * WM8994 Controls
+ */
+
+static const char *bass_boost_txt[] = {"Linear Control", "Adaptive Boost"};
+static const struct soc_enum bass_boost =
+       SOC_ENUM_SINGLE(WM8994_BASS, 7, 2, bass_boost_txt);
+
+static const char *bass_filter_txt[] = { "130Hz @ 48kHz", "200Hz @ 48kHz" };
+static const struct soc_enum bass_filter =
+       SOC_ENUM_SINGLE(WM8994_BASS, 6, 2, bass_filter_txt);
+
+static const char *treble_txt[] = {"8kHz", "4kHz"};
+static const struct soc_enum treble =
+       SOC_ENUM_SINGLE(WM8994_TREBLE, 6, 2, treble_txt);
+
+static const char *stereo_3d_lc_txt[] = {"200Hz", "500Hz"};
+static const struct soc_enum stereo_3d_lc =
+       SOC_ENUM_SINGLE(WM8994_3D, 5, 2, stereo_3d_lc_txt);
+
+static const char *stereo_3d_uc_txt[] = {"2.2kHz", "1.5kHz"};
+static const struct soc_enum stereo_3d_uc =
+       SOC_ENUM_SINGLE(WM8994_3D, 6, 2, stereo_3d_uc_txt);
+
+static const char *stereo_3d_func_txt[] = {"Capture", "Playback"};
+static const struct soc_enum stereo_3d_func =
+       SOC_ENUM_SINGLE(WM8994_3D, 7, 2, stereo_3d_func_txt);
+
+static const char *alc_func_txt[] = {"Off", "Right", "Left", "Stereo"};
+static const struct soc_enum alc_func =
+       SOC_ENUM_SINGLE(WM8994_ALC1, 7, 4, alc_func_txt);
+
+static const char *ng_type_txt[] = {"Constant PGA Gain",
+                                   "Mute ADC Output"};
+static const struct soc_enum ng_type =
+       SOC_ENUM_SINGLE(WM8994_NGATE, 1, 2, ng_type_txt);
+
+static const char *deemph_txt[] = {"None", "32Khz", "44.1Khz", "48Khz"};
+static const struct soc_enum deemph =
+       SOC_ENUM_SINGLE(WM8994_ADCDAC, 1, 4, deemph_txt);
+
+static const char *adcpol_txt[] = {"Normal", "L Invert", "R Invert",
+                                  "L + R Invert"};
+static const struct soc_enum adcpol =
+       SOC_ENUM_SINGLE(WM8994_ADCDAC, 5, 4, adcpol_txt);
+
+static const DECLARE_TLV_DB_SCALE(pga_tlv, -1725, 75, 0);
+static const DECLARE_TLV_DB_SCALE(adc_tlv, -9750, 50, 1);
+static const DECLARE_TLV_DB_SCALE(dac_tlv, -12750, 50, 1);
+static const DECLARE_TLV_DB_SCALE(out_tlv, -12100, 100, 1);
+static const DECLARE_TLV_DB_SCALE(bypass_tlv, -1500, 300, 0);
+
+static const struct snd_kcontrol_new wm8994_snd_controls[] = {
+
+/* 鍠囧彮 */
+SOC_DOUBLE_SWITCH_WM8994CODEC("Speaker incall Switch", SPEAKER_INCALL),        
+SOC_DOUBLE_SWITCH_WM8994CODEC("Speaker normal Switch", SPEAKER_NORMAL),
+/* 鍚瓛 */
+SOC_DOUBLE_SWITCH_WM8994CODEC("Earpiece incall Switch", EARPIECE_INCALL),      
+SOC_DOUBLE_SWITCH_WM8994CODEC("Earpiece normal Switch", EARPIECE_NORMAL),
+/* 鑰虫満 */
+SOC_DOUBLE_SWITCH_WM8994CODEC("Headset incall Switch", HEADSET_INCALL),        
+SOC_DOUBLE_SWITCH_WM8994CODEC("Headset normal Switch", HEADSET_NORMAL),
+/* 钃濈墮SCO */
+SOC_DOUBLE_SWITCH_WM8994CODEC("Bluetooth incall Switch", BLUETOOTH_SCO_INCALL),        
+SOC_DOUBLE_SWITCH_WM8994CODEC("Bluetooth normal Switch", BLUETOOTH_SCO_NORMAL),
+/* 钃濈墮A2DP */
+SOC_DOUBLE_SWITCH_WM8994CODEC("Bluetooth-A2DP incall Switch", BLUETOOTH_A2DP_INCALL),  
+SOC_DOUBLE_SWITCH_WM8994CODEC("Bluetooth-A2DP normal Switch", BLUETOOTH_A2DP_NORMAL),
+/* 鑰抽害 */
+SOC_DOUBLE_SWITCH_WM8994CODEC("Capture Switch", MIC_CAPTURE),
+
+};
+
+/*
+ * DAPM Controls
+ */
+
+static int wm8994_lrc_control(struct snd_soc_dapm_widget *w,
+                             struct snd_kcontrol *kcontrol, int event)
+{
+       struct snd_soc_codec *codec = w->codec;
+       u16 adctl2 = snd_soc_read(codec, WM8994_ADCTL2);
+
+       /* Use the DAC to gate LRC if active, otherwise use ADC */
+       if (snd_soc_read(codec, WM8994_PWR2) & 0x180)
+               adctl2 &= ~0x4;
+       else
+               adctl2 |= 0x4;
+
+       DBG("Enter::%s----line->%d, adctl2 = %x\n",__FUNCTION__,__LINE__,adctl2);
+       
+       return snd_soc_write(codec, WM8994_ADCTL2, adctl2);
+}
+
+static const char *wm8994_line_texts[] = {
+       "Line 1", "Line 2", "PGA", "Differential"};
+
+static const unsigned int wm8994_line_values[] = {
+       0, 1, 3, 4};
+
+static const struct soc_enum wm8994_lline_enum =
+       SOC_VALUE_ENUM_SINGLE(WM8994_LOUTM1, 0, 7,
+                             ARRAY_SIZE(wm8994_line_texts),
+                             wm8994_line_texts,
+                             wm8994_line_values);
+static const struct snd_kcontrol_new wm8994_left_line_controls =
+       SOC_DAPM_VALUE_ENUM("Route", wm8994_lline_enum);
+
+static const struct soc_enum wm8994_rline_enum =
+       SOC_VALUE_ENUM_SINGLE(WM8994_ROUTM1, 0, 7,
+                             ARRAY_SIZE(wm8994_line_texts),
+                             wm8994_line_texts,
+                             wm8994_line_values);
+static const struct snd_kcontrol_new wm8994_right_line_controls =
+       SOC_DAPM_VALUE_ENUM("Route", wm8994_lline_enum);
+
+/* Left Mixer */
+static const struct snd_kcontrol_new wm8994_left_mixer_controls[] = {
+       SOC_DAPM_SINGLE("Playback Switch", WM8994_LOUTM1, 8, 1, 0),
+       SOC_DAPM_SINGLE("Left Bypass Switch", WM8994_LOUTM1, 7, 1, 0),
+       SOC_DAPM_SINGLE("Right Playback Switch", WM8994_LOUTM2, 8, 1, 0),
+       SOC_DAPM_SINGLE("Right Bypass Switch", WM8994_LOUTM2, 7, 1, 0),
+};
+
+/* Right Mixer */
+static const struct snd_kcontrol_new wm8994_right_mixer_controls[] = {
+       SOC_DAPM_SINGLE("Left Playback Switch", WM8994_ROUTM1, 8, 1, 0),
+       SOC_DAPM_SINGLE("Left Bypass Switch", WM8994_ROUTM1, 7, 1, 0),
+       SOC_DAPM_SINGLE("Playback Switch", WM8994_ROUTM2, 8, 1, 0),
+       SOC_DAPM_SINGLE("Right Bypass Switch", WM8994_ROUTM2, 7, 1, 0),
+};
+
+static const char *wm8994_pga_sel[] = {"Line 1", "Line 2", "Differential"};
+static const unsigned int wm8994_pga_val[] = { 0, 1, 3 };
+
+/* Left PGA Mux */
+static const struct soc_enum wm8994_lpga_enum =
+       SOC_VALUE_ENUM_SINGLE(WM8994_LADCIN, 6, 3,
+                             ARRAY_SIZE(wm8994_pga_sel),
+                             wm8994_pga_sel,
+                             wm8994_pga_val);
+static const struct snd_kcontrol_new wm8994_left_pga_controls =
+       SOC_DAPM_VALUE_ENUM("Route", wm8994_lpga_enum);
+
+/* Right PGA Mux */
+static const struct soc_enum wm8994_rpga_enum =
+       SOC_VALUE_ENUM_SINGLE(WM8994_RADCIN, 6, 3,
+                             ARRAY_SIZE(wm8994_pga_sel),
+                             wm8994_pga_sel,
+                             wm8994_pga_val);
+static const struct snd_kcontrol_new wm8994_right_pga_controls =
+       SOC_DAPM_VALUE_ENUM("Route", wm8994_rpga_enum);
+
+/* Differential Mux */
+static const char *wm8994_diff_sel[] = {"Line 1", "Line 2"};
+static const struct soc_enum diffmux =
+       SOC_ENUM_SINGLE(WM8994_ADCIN, 8, 2, wm8994_diff_sel);
+static const struct snd_kcontrol_new wm8994_diffmux_controls =
+       SOC_DAPM_ENUM("Route", diffmux);
+
+/* Mono ADC Mux */
+static const char *wm8994_mono_mux[] = {"Stereo", "Mono (Left)",
+       "Mono (Right)", "Digital Mono"};
+static const struct soc_enum monomux =
+       SOC_ENUM_SINGLE(WM8994_ADCIN, 6, 4, wm8994_mono_mux);
+static const struct snd_kcontrol_new wm8994_monomux_controls =
+       SOC_DAPM_ENUM("Route", monomux);
+
+static const struct snd_soc_dapm_widget wm8994_dapm_widgets[] = {
+       SND_SOC_DAPM_MICBIAS("Mic Bias", WM8994_PWR1, 1, 0),
+
+       SND_SOC_DAPM_MUX("Differential Mux", SND_SOC_NOPM, 0, 0,
+               &wm8994_diffmux_controls),
+       SND_SOC_DAPM_MUX("Left ADC Mux", SND_SOC_NOPM, 0, 0,
+               &wm8994_monomux_controls),
+       SND_SOC_DAPM_MUX("Right ADC Mux", SND_SOC_NOPM, 0, 0,
+               &wm8994_monomux_controls),
+
+       SND_SOC_DAPM_MUX("Left PGA Mux", WM8994_PWR1, 5, 0,
+               &wm8994_left_pga_controls),
+       SND_SOC_DAPM_MUX("Right PGA Mux", WM8994_PWR1, 4, 0,
+               &wm8994_right_pga_controls),
+
+       SND_SOC_DAPM_MUX("Left Line Mux", SND_SOC_NOPM, 0, 0,
+               &wm8994_left_line_controls),
+       SND_SOC_DAPM_MUX("Right Line Mux", SND_SOC_NOPM, 0, 0,
+               &wm8994_right_line_controls),
+
+       SND_SOC_DAPM_ADC("Right ADC", "Right Capture", WM8994_PWR1, 2, 0),
+       SND_SOC_DAPM_ADC("Left ADC", "Left Capture", WM8994_PWR1, 3, 0),
+
+       SND_SOC_DAPM_DAC("Right DAC", "Right Playback", WM8994_PWR2, 7, 0),
+       SND_SOC_DAPM_DAC("Left DAC", "Left Playback", WM8994_PWR2, 8, 0),
+
+       SND_SOC_DAPM_MIXER("Left Mixer", SND_SOC_NOPM, 0, 0,
+               &wm8994_left_mixer_controls[0],
+               ARRAY_SIZE(wm8994_left_mixer_controls)),
+       SND_SOC_DAPM_MIXER("Right Mixer", SND_SOC_NOPM, 0, 0,
+               &wm8994_right_mixer_controls[0],
+               ARRAY_SIZE(wm8994_right_mixer_controls)),
+
+       SND_SOC_DAPM_PGA("Right Out 2", WM8994_PWR2, 3, 0, NULL, 0),
+       SND_SOC_DAPM_PGA("Left Out 2", WM8994_PWR2, 4, 0, NULL, 0),
+       SND_SOC_DAPM_PGA("Right Out 1", WM8994_PWR2, 5, 0, NULL, 0),
+       SND_SOC_DAPM_PGA("Left Out 1", WM8994_PWR2, 6, 0, NULL, 0),
+
+       SND_SOC_DAPM_POST("LRC control", wm8994_lrc_control),
+
+       SND_SOC_DAPM_OUTPUT("LOUT1"),
+       SND_SOC_DAPM_OUTPUT("ROUT1"),
+       SND_SOC_DAPM_OUTPUT("LOUT2"),
+       SND_SOC_DAPM_OUTPUT("ROUT2"),
+       SND_SOC_DAPM_OUTPUT("VREF"),
+
+       SND_SOC_DAPM_INPUT("LINPUT1"),
+       SND_SOC_DAPM_INPUT("LINPUT2"),
+       SND_SOC_DAPM_INPUT("RINPUT1"),
+       SND_SOC_DAPM_INPUT("RINPUT2"),
+};
+
+static const struct snd_soc_dapm_route audio_map[] = {
+
+       { "Left Line Mux", "Line 1", "LINPUT1" },
+       { "Left Line Mux", "Line 2", "LINPUT2" },
+       { "Left Line Mux", "PGA", "Left PGA Mux" },
+       { "Left Line Mux", "Differential", "Differential Mux" },
+
+       { "Right Line Mux", "Line 1", "RINPUT1" },
+       { "Right Line Mux", "Line 2", "RINPUT2" },
+       { "Right Line Mux", "PGA", "Right PGA Mux" },
+       { "Right Line Mux", "Differential", "Differential Mux" },
+
+       { "Left PGA Mux", "Line 1", "LINPUT1" },
+       { "Left PGA Mux", "Line 2", "LINPUT2" },
+       { "Left PGA Mux", "Differential", "Differential Mux" },
+
+       { "Right PGA Mux", "Line 1", "RINPUT1" },
+       { "Right PGA Mux", "Line 2", "RINPUT2" },
+       { "Right PGA Mux", "Differential", "Differential Mux" },
+
+       { "Differential Mux", "Line 1", "LINPUT1" },
+       { "Differential Mux", "Line 1", "RINPUT1" },
+       { "Differential Mux", "Line 2", "LINPUT2" },
+       { "Differential Mux", "Line 2", "RINPUT2" },
+
+       { "Left ADC Mux", "Stereo", "Left PGA Mux" },
+       { "Left ADC Mux", "Mono (Left)", "Left PGA Mux" },
+       { "Left ADC Mux", "Digital Mono", "Left PGA Mux" },
+
+       { "Right ADC Mux", "Stereo", "Right PGA Mux" },
+       { "Right ADC Mux", "Mono (Right)", "Right PGA Mux" },
+       { "Right ADC Mux", "Digital Mono", "Right PGA Mux" },
+
+       { "Left ADC", NULL, "Left ADC Mux" },
+       { "Right ADC", NULL, "Right ADC Mux" },
+
+       { "Left Line Mux", "Line 1", "LINPUT1" },
+       { "Left Line Mux", "Line 2", "LINPUT2" },
+       { "Left Line Mux", "PGA", "Left PGA Mux" },
+       { "Left Line Mux", "Differential", "Differential Mux" },
+
+       { "Right Line Mux", "Line 1", "RINPUT1" },
+       { "Right Line Mux", "Line 2", "RINPUT2" },
+       { "Right Line Mux", "PGA", "Right PGA Mux" },
+       { "Right Line Mux", "Differential", "Differential Mux" },
+
+       { "Left Mixer", "Playback Switch", "Left DAC" },
+       { "Left Mixer", "Left Bypass Switch", "Left Line Mux" },
+       { "Left Mixer", "Right Playback Switch", "Right DAC" },
+       { "Left Mixer", "Right Bypass Switch", "Right Line Mux" },
+
+       { "Right Mixer", "Left Playback Switch", "Left DAC" },
+       { "Right Mixer", "Left Bypass Switch", "Left Line Mux" },
+       { "Right Mixer", "Playback Switch", "Right DAC" },
+       { "Right Mixer", "Right Bypass Switch", "Right Line Mux" },
+
+       { "Left Out 1", NULL, "Left Mixer" },
+       { "LOUT1", NULL, "Left Out 1" },
+       { "Right Out 1", NULL, "Right Mixer" },
+       { "ROUT1", NULL, "Right Out 1" },
+
+       { "Left Out 2", NULL, "Left Mixer" },
+       { "LOUT2", NULL, "Left Out 2" },
+       { "Right Out 2", NULL, "Right Mixer" },
+       { "ROUT2", NULL, "Right Out 2" },
+};
+
+struct _coeff_div {
+       u32 mclk;
+       u32 rate;
+       u16 fs;
+       u8 sr:5;
+       u8 usb:1;
+};
+
+/* codec hifi mclk clock divider coefficients */
+static const struct _coeff_div coeff_div[] = {
+       /* 8k */
+       {12288000, 8000, 1536, 0x6, 0x0},
+       {11289600, 8000, 1408, 0x16, 0x0},
+       {18432000, 8000, 2304, 0x7, 0x0},
+       {16934400, 8000, 2112, 0x17, 0x0},
+       {12000000, 8000, 1500, 0x6, 0x1},
+
+       /* 11.025k */
+       {11289600, 11025, 1024, 0x18, 0x0},
+       {16934400, 11025, 1536, 0x19, 0x0},
+       {12000000, 11025, 1088, 0x19, 0x1},
+
+       /* 16k */
+       {12288000, 16000, 768, 0xa, 0x0},
+       {18432000, 16000, 1152, 0xb, 0x0},
+       {12000000, 16000, 750, 0xa, 0x1},
+
+       /* 22.05k */
+       {11289600, 22050, 512, 0x1a, 0x0},
+       {16934400, 22050, 768, 0x1b, 0x0},
+       {12000000, 22050, 544, 0x1b, 0x1},
+
+       /* 32k */
+       {12288000, 32000, 384, 0xc, 0x0},
+       {18432000, 32000, 576, 0xd, 0x0},
+       {12000000, 32000, 375, 0xa, 0x1},
+
+       /* 44.1k */
+       {11289600, 44100, 256, 0x10, 0x0},
+       {16934400, 44100, 384, 0x11, 0x0},
+       {12000000, 44100, 272, 0x11, 0x1},
+
+       /* 48k */
+       {12288000, 48000, 256, 0x0, 0x0},
+       {18432000, 48000, 384, 0x1, 0x0},
+       {12000000, 48000, 250, 0x0, 0x1},
+
+       /* 88.2k */
+       {11289600, 88200, 128, 0x1e, 0x0},
+       {16934400, 88200, 192, 0x1f, 0x0},
+       {12000000, 88200, 136, 0x1f, 0x1},
+
+       /* 96k */
+       {12288000, 96000, 128, 0xe, 0x0},
+       {18432000, 96000, 192, 0xf, 0x0},
+       {12000000, 96000, 125, 0xe, 0x1},
+};
+
+
+static inline int get_coeff(int mclk, int rate)
+{
+       int i;
+
+       for (i = 0; i < ARRAY_SIZE(coeff_div); i++) {
+               if (coeff_div[i].rate == rate && coeff_div[i].mclk == mclk)
+                       return i;
+       }
+
+       return -EINVAL;
+}
+
+/* The set of rates we can generate from the above for each SYSCLK */
+
+static unsigned int rates_12288[] = {
+       8000, 12000, 16000, 24000, 24000, 32000, 48000, 96000,
+};
+
+static struct snd_pcm_hw_constraint_list constraints_12288 = {
+       .count  = ARRAY_SIZE(rates_12288),
+       .list   = rates_12288,
+};
+
+static unsigned int rates_112896[] = {
+       8000, 11025, 22050, 44100,
+};
+
+static struct snd_pcm_hw_constraint_list constraints_112896 = {
+       .count  = ARRAY_SIZE(rates_112896),
+       .list   = rates_112896,
+};
+
+static unsigned int rates_12[] = {
+       8000, 11025, 12000, 16000, 22050, 2400, 32000, 41100, 48000,
+       48000, 88235, 96000,
+};
+
+static struct snd_pcm_hw_constraint_list constraints_12 = {
+       .count  = ARRAY_SIZE(rates_12),
+       .list   = rates_12,
+};
+
+/*
+ * Note that this should be called from init rather than from hw_params.
+ */
+static int wm8994_set_dai_sysclk(struct snd_soc_dai *codec_dai,
+               int clk_id, unsigned int freq, int dir)
+{
+       struct snd_soc_codec *codec = codec_dai->codec;
+       struct wm8994_priv *wm8994 = codec->private_data;
+       
+       DBG("Enter::%s----line->%d\n",__FUNCTION__,__LINE__);
+               
+       switch (freq) {
+       case 11289600:
+       case 18432000:
+       case 22579200:
+       case 36864000:
+               wm8994->sysclk_constraints = &constraints_112896;
+               wm8994->sysclk = freq;
+               return 0;
+
+       case 12288000:
+       case 16934400:
+       case 24576000:
+       case 33868800:
+               wm8994->sysclk_constraints = &constraints_12288;
+               wm8994->sysclk = freq;
+               return 0;
+
+       case 12000000:
+       case 24000000:
+               wm8994->sysclk_constraints = &constraints_12;
+               wm8994->sysclk = freq;
+               return 0;
+       }
+       return -EINVAL;
+}
+
+static int wm8994_set_dai_fmt(struct snd_soc_dai *codec_dai,
+               unsigned int fmt)
+{
+       struct snd_soc_codec *codec = codec_dai->codec;
+       u16 iface = 0;
+
+       /* set master/slave audio interface */
+       switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
+       case SND_SOC_DAIFMT_CBM_CFM:
+               iface = 0x0040;
+               break;
+       case SND_SOC_DAIFMT_CBS_CFS:
+               break;
+       default:
+               return -EINVAL;
+       }
+
+       /* interface format */
+       switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
+       case SND_SOC_DAIFMT_I2S:
+               iface |= 0x0002;
+               break;
+       case SND_SOC_DAIFMT_RIGHT_J:
+               break;
+       case SND_SOC_DAIFMT_LEFT_J:
+               iface |= 0x0001;
+               break;
+       case SND_SOC_DAIFMT_DSP_A:
+               iface |= 0x0003;
+               break;
+       case SND_SOC_DAIFMT_DSP_B:
+               iface |= 0x0013;
+               break;
+       default:
+               return -EINVAL;
+       }
+
+       /* clock inversion */
+       switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
+       case SND_SOC_DAIFMT_NB_NF:
+               break;
+       case SND_SOC_DAIFMT_IB_IF:
+               iface |= 0x0090;
+               break;
+       case SND_SOC_DAIFMT_IB_NF:
+               iface |= 0x0080;
+               break;
+       case SND_SOC_DAIFMT_NB_IF:
+               iface |= 0x0010;
+               break;
+       default:
+               return -EINVAL;
+       }
+
+       DBG("Enter::%s----line->%d  iface=%x\n",__FUNCTION__,__LINE__,iface);
+       snd_soc_write(codec, WM8994_IFACE, iface);
+       return 0;
+}
+
+static int wm8994_pcm_startup(struct snd_pcm_substream *substream,
+                             struct snd_soc_dai *dai)
+{
+       struct snd_soc_codec *codec = dai->codec;
+       struct wm8994_priv *wm8994 = codec->private_data;
+       
+       /* The set of sample rates that can be supported depends on the
+        * MCLK supplied to the CODEC - enforce this.
+        */
+       DBG("Enter::%s----line->%d  wm8994->sysclk=%d\n",__FUNCTION__,__LINE__,wm8994->sysclk); 
+       if (!wm8994->sysclk) {
+               dev_err(codec->dev,
+                       "No MCLK configured, call set_sysclk() on init\n");
+               return -EINVAL;
+       }
+
+       snd_pcm_hw_constraint_list(substream->runtime, 0,
+                                  SNDRV_PCM_HW_PARAM_RATE,
+                                  wm8994->sysclk_constraints);
+
+       return 0;
+}
+
+static int wm8994_pcm_hw_params(struct snd_pcm_substream *substream,
+                               struct snd_pcm_hw_params *params,
+                               struct snd_soc_dai *dai)
+{
+       struct snd_soc_pcm_runtime *rtd = substream->private_data;
+       struct snd_soc_device *socdev = rtd->socdev;
+       struct snd_soc_codec *codec = socdev->card->codec;
+       struct wm8994_priv *wm8994 = codec->private_data;
+       u16 iface = snd_soc_read(codec, WM8994_IFACE) & 0x1f3;
+       u16 srate = snd_soc_read(codec, WM8994_SRATE) & 0x180;
+       int coeff;
+       
+       coeff = get_coeff(wm8994->sysclk, params_rate(params));
+       if (coeff < 0) {
+               coeff = get_coeff(wm8994->sysclk / 2, params_rate(params));
+               srate |= 0x40;
+       }
+       if (coeff < 0) {
+               dev_err(codec->dev,
+                       "Unable to configure sample rate %dHz with %dHz MCLK\n",
+                       params_rate(params), wm8994->sysclk);
+               return coeff;
+       }
+
+       /* bit size */
+       switch (params_format(params)) {
+       case SNDRV_PCM_FORMAT_S16_LE:
+               break;
+       case SNDRV_PCM_FORMAT_S20_3LE:
+               iface |= 0x0004;
+               break;
+       case SNDRV_PCM_FORMAT_S24_LE:
+               iface |= 0x0008;
+               break;
+       case SNDRV_PCM_FORMAT_S32_LE:
+               iface |= 0x000c;
+               break;
+       }
+       DBG("Enter::%s----line->%d  iface=%x srate =%x rate=%d\n",__FUNCTION__,__LINE__,iface,srate,params_rate(params));
+
+       /* set iface & srate */
+       snd_soc_write(codec, WM8994_IFACE, iface);
+       if (coeff >= 0)
+               snd_soc_write(codec, WM8994_SRATE, srate |
+                       (coeff_div[coeff].sr << 1) | coeff_div[coeff].usb);
+
+       return 0;
+}
+
+static int wm8994_mute(struct snd_soc_dai *dai, int mute)
+{
+       return 0;
+}
+
+static int wm8994_set_bias_level(struct snd_soc_codec *codec,
+                                enum snd_soc_bias_level level)
+{
+       u16 pwr_reg = snd_soc_read(codec, WM8994_PWR1) & ~0x1c1;
+       DBG("Enter::%s----line->%d level =%d\n",__FUNCTION__,__LINE__,level);
+       switch (level) {
+       case SND_SOC_BIAS_ON:
+               break;
+
+       case SND_SOC_BIAS_PREPARE:
+               /* VREF, VMID=2x50k, digital enabled */
+               snd_soc_write(codec, WM8994_PWR1, pwr_reg | 0x00c0);
+               break;
+
+       case SND_SOC_BIAS_STANDBY:
+               if (codec->bias_level == SND_SOC_BIAS_OFF) {
+                       /* VREF, VMID=2x5k */
+                       snd_soc_write(codec, WM8994_PWR1, pwr_reg | 0x1c1);
+
+                       /* Charge caps */
+                       msleep(100);
+               }
+
+               /* VREF, VMID=2*500k, digital stopped */
+               snd_soc_write(codec, WM8994_PWR1, pwr_reg | 0x0141);
+               break;
+
+       case SND_SOC_BIAS_OFF:
+               snd_soc_write(codec, WM8994_PWR1, 0x0000);
+               break;
+       }
+       codec->bias_level = level;
+       return 0;
+}
+
+#define WM8994_RATES SNDRV_PCM_RATE_8000_96000
+
+#define WM8994_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
+       SNDRV_PCM_FMTBIT_S24_LE)
+
+static struct snd_soc_dai_ops wm8994_ops = {
+       .startup = wm8994_pcm_startup,
+       .hw_params = wm8994_pcm_hw_params,
+       .set_fmt = wm8994_set_dai_fmt,
+       .set_sysclk = wm8994_set_dai_sysclk,
+       .digital_mute = wm8994_mute,
+};
+
+struct snd_soc_dai wm8994_dai = {
+       .name = "WM8994",
+       .playback = {
+               .stream_name = "Playback",
+               .channels_min = 1,
+               .channels_max = 2,
+               .rates = WM8994_RATES,
+               .formats = WM8994_FORMATS,
+       },
+       .capture = {
+               .stream_name = "Capture",
+               .channels_min = 1,
+               .channels_max = 2,
+               .rates = WM8994_RATES,
+               .formats = WM8994_FORMATS,
+        },
+       .ops = &wm8994_ops,
+       .symmetric_rates = 1,
+};
+EXPORT_SYMBOL_GPL(wm8994_dai);
+
+static int wm8994_suspend(struct platform_device *pdev, pm_message_t state)
+{
+       struct snd_soc_device *socdev = platform_get_drvdata(pdev);
+       struct snd_soc_codec *codec = socdev->card->codec;
+       DBG("Enter::%s----line->%d\n",__FUNCTION__,__LINE__);
+       wm8994_set_bias_level(codec, SND_SOC_BIAS_OFF);
+       wm8994_reset();
+       mdelay(50);
+       return 0;
+}
+
+static int wm8994_resume(struct platform_device *pdev)
+{
+       struct snd_soc_device *socdev = platform_get_drvdata(pdev);
+       struct snd_soc_codec *codec = socdev->card->codec;
+       int i;
+       u8 data[2];
+       u16 *cache = codec->reg_cache;
+       wm8994_codec_fnc_t **wm8994_fnc_ptr=wm8994_codec_sequence;
+       DBG("Enter::%s----line->%d\n",__FUNCTION__,__LINE__);
+       /* Sync reg_cache with the hardware */
+       for (i = 0; i < WM8994_NUM_REG; i++) {
+               if (i == WM8994_RESET)
+                       continue;
+               data[0] = (i << 1) | ((cache[i] >> 8) & 0x0001);
+               data[1] = cache[i] & 0x00ff;
+               codec->hw_write(codec->control_data, data, 2);
+       }
+
+       wm8994_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
+       if(wm8994_mode<=wm8994_AP_to_Speakers)
+       {
+               wm8994_fnc_ptr+=wm8994_mode;
+               (*wm8994_fnc_ptr)() ;
+       }
+       else
+       {
+               wm8994_fnc_ptr+=wm8994_mode;
+               (*wm8994_fnc_ptr)() ;
+               printk("%s----line->%d--: Wm8994 resume with error mode\n",__FUNCTION__,__LINE__);
+       }
+
+       return 0;
+}
+
+static struct snd_soc_codec *wm8994_codec;
+
+static int wm8994_probe(struct platform_device *pdev)
+{
+       struct snd_soc_device *socdev = platform_get_drvdata(pdev);
+       struct snd_soc_codec *codec;
+       int ret = 0;
+
+       if (wm8994_codec == NULL) {
+               dev_err(&pdev->dev, "Codec device not registered\n");
+               return -ENODEV;
+       }
+
+       socdev->card->codec = wm8994_codec;
+       codec = wm8994_codec;
+
+       /* register pcms */
+       ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
+       if (ret < 0) {
+               dev_err(codec->dev, "failed to create pcms: %d\n", ret);
+               goto pcm_err;
+       }
+
+       snd_soc_add_controls(codec, wm8994_snd_controls,
+                               ARRAY_SIZE(wm8994_snd_controls));
+       snd_soc_dapm_new_controls(codec, wm8994_dapm_widgets,
+                                 ARRAY_SIZE(wm8994_dapm_widgets));
+       snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
+       snd_soc_dapm_new_widgets(codec);
+
+       ret = snd_soc_init_card(socdev);
+       if (ret < 0) {
+               dev_err(codec->dev, "failed to register card: %d\n", ret);
+               goto card_err;
+       }
+
+       return ret;
+
+card_err:
+       snd_soc_free_pcms(socdev);
+       snd_soc_dapm_free(socdev);
+pcm_err:
+       return ret;
+}
+
+static int wm8994_remove(struct platform_device *pdev)
+{
+       struct snd_soc_device *socdev = platform_get_drvdata(pdev);
+
+       snd_soc_free_pcms(socdev);
+       snd_soc_dapm_free(socdev);
+
+       return 0;
+}
+
+struct snd_soc_codec_device soc_codec_dev_wm8994 = {
+       .probe =        wm8994_probe,
+       .remove =       wm8994_remove,
+       .suspend =      wm8994_suspend,
+       .resume =       wm8994_resume,
+};
+EXPORT_SYMBOL_GPL(soc_codec_dev_wm8994);
+
+static int wm8994_register(struct wm8994_priv *wm8994,
+                          enum snd_soc_control_type control)
+{
+       struct snd_soc_codec *codec = &wm8994->codec;
+       int ret;
+       u16 reg;
+
+       /*************text----------cjq**************/
+       DBG("\n\n\nEnter::%s----line->%d-- WM8994 test begin\n",__FUNCTION__,__LINE__);
+       AP_to_Headset();
+       //HandsetMIC_to_Baseband_to_Headset();
+       DBG("Enter::%s----line->%d-- WM8994 test end\n\n\n\n",__FUNCTION__,__LINE__);
+
+       if (wm8994_codec) {
+               dev_err(codec->dev, "Another WM8994 is registered\n");
+               ret = -EINVAL;
+               goto err;
+       }
+
+       mutex_init(&codec->mutex);
+       INIT_LIST_HEAD(&codec->dapm_widgets);
+       INIT_LIST_HEAD(&codec->dapm_paths);
+
+       codec->private_data = wm8994;
+       codec->name = "WM8994";
+       codec->owner = THIS_MODULE;
+       codec->dai = &wm8994_dai;
+       codec->num_dai = 1;
+       codec->reg_cache_size = ARRAY_SIZE(wm8994->reg_cache);
+       codec->reg_cache = &wm8994->reg_cache;
+       codec->bias_level = SND_SOC_BIAS_OFF;
+       codec->set_bias_level = wm8994_set_bias_level;
+
+       memcpy(codec->reg_cache, wm8994_reg,
+              sizeof(wm8994_reg));
+
+       ret = snd_soc_codec_set_cache_io(codec, 7, 9, control);
+       if (ret < 0) {
+               dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
+               goto err;
+       }
+
+       ret = 0;//wm8994_reset(); cjq
+       if (ret < 0) {
+               dev_err(codec->dev, "Failed to issue reset\n");
+               goto err;
+       }
+#if 1
+               /*disable speaker */
+               gpio_request(RK2818_PIN_PF7, "WM8994"); 
+               rk2818_mux_api_set(GPIOE_SPI1_FLASH_SEL_NAME, IOMUXA_GPIO1_A3B7);
+               gpio_direction_output(RK2818_PIN_PF7,GPIO_HIGH);
+               
+#endif
+       /* set the update bits (we always update left then right) */
+       reg = snd_soc_read(codec, WM8994_RADC);
+       snd_soc_write(codec, WM8994_RADC, reg | 0x100);
+       reg = snd_soc_read(codec, WM8994_RDAC);
+       snd_soc_write(codec, WM8994_RDAC, reg | 0x0100);
+       reg = snd_soc_read(codec, WM8994_ROUT1V);
+       snd_soc_write(codec, WM8994_ROUT1V, reg | 0x0100);
+       reg = snd_soc_read(codec, WM8994_ROUT2V);
+       snd_soc_write(codec, WM8994_ROUT2V, reg | 0x0100);
+       reg = snd_soc_read(codec, WM8994_RINVOL);
+       snd_soc_write(codec, WM8994_RINVOL, reg | 0x0100); 
+       
+       snd_soc_write(codec, WM8994_LOUTM1, 0x120); 
+       snd_soc_write(codec, WM8994_ROUTM2, 0x120);  
+       snd_soc_write(codec, WM8994_LOUTM2, 0x0070);
+       snd_soc_write(codec, WM8994_ROUTM1, 0x0070);
+       
+       snd_soc_write(codec, WM8994_LOUT1V, 0x017f); 
+       snd_soc_write(codec, WM8994_ROUT1V, 0x017f);
+       snd_soc_write(codec, WM8994_LDAC, 0xff);  
+       snd_soc_write(codec, WM8994_RDAC, 0x1ff);//vol set 
+       
+       snd_soc_write(codec, WM8994_SRATE,0x100);  ///SET MCLK/8
+       snd_soc_write(codec, WM8994_PWR1, 0x1cc);  ///(0x80|0x40|0x20|0x08|0x04|0x10|0x02));
+       snd_soc_write(codec, WM8994_PWR2, 0x1e0);  //power r l out1
+
+
+       wm8994_set_bias_level(&wm8994->codec, SND_SOC_BIAS_STANDBY);
+
+       wm8994_dai.dev = codec->dev;
+
+       wm8994_codec = codec;
+
+       ret = snd_soc_register_codec(codec);
+       if (ret != 0) {
+               dev_err(codec->dev, "Failed to register codec: %d\n", ret);
+               goto err;
+       }
+
+       ret = snd_soc_register_dai(&wm8994_dai);
+       if (ret != 0) {
+               dev_err(codec->dev, "Failed to register DAI: %d\n", ret);
+               snd_soc_unregister_codec(codec);
+               goto err_codec;
+       }
+       return 0;
+
+err_codec:
+       snd_soc_unregister_codec(codec);
+err:
+       kfree(wm8994);
+       return ret;
+}
+
+static void wm8994_unregister(struct wm8994_priv *wm8994)
+{
+       wm8994_set_bias_level(&wm8994->codec, SND_SOC_BIAS_OFF);
+       snd_soc_unregister_dai(&wm8994_dai);
+       snd_soc_unregister_codec(&wm8994->codec);
+       kfree(wm8994);
+       wm8994_codec = NULL;
+}
+
+#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
+static int wm8994_i2c_probe(struct i2c_client *i2c,
+                           const struct i2c_device_id *id)
+{
+       struct wm8994_priv *wm8994;
+       struct snd_soc_codec *codec;
+       wm8994_client=i2c;
+       wm8994 = kzalloc(sizeof(struct wm8994_priv), GFP_KERNEL);
+       if (wm8994 == NULL)
+               return -ENOMEM;
+
+       codec = &wm8994->codec;
+
+       i2c_set_clientdata(i2c, wm8994);
+       codec->control_data = i2c;
+
+       codec->dev = &i2c->dev;
+
+       return wm8994_register(wm8994, SND_SOC_I2C);
+}
+
+static int wm8994_i2c_remove(struct i2c_client *client)
+{
+       struct wm8994_priv *wm8994 = i2c_get_clientdata(client);
+       wm8994_unregister(wm8994);
+       return 0;
+}
+
+#ifdef CONFIG_PM
+static int wm8994_i2c_suspend(struct i2c_client *client, pm_message_t msg)
+{
+       return snd_soc_suspend_device(&client->dev);
+}
+
+static int wm8994_i2c_resume(struct i2c_client *client)
+{
+       return snd_soc_resume_device(&client->dev);
+}
+#else
+#define wm8994_i2c_suspend NULL
+#define wm8994_i2c_resume NULL
+#endif
+
+static const struct i2c_device_id wm8994_i2c_id[] = {
+       { "wm8994", 0 },
+       { }
+};
+MODULE_DEVICE_TABLE(i2c, wm8994_i2c_id);
+
+static struct i2c_driver wm8994_i2c_driver = {
+       .driver = {
+               .name = "WM8994",
+               .owner = THIS_MODULE,
+       },
+       .probe = wm8994_i2c_probe,
+       .remove = wm8994_i2c_remove,
+       .suspend = wm8994_i2c_suspend,
+       .resume = wm8994_i2c_resume,
+       .id_table = wm8994_i2c_id,
+};
+
+int reg_send_data(struct i2c_client *client, unsigned short *reg, unsigned short *data, u32 scl_rate)
+{
+       int ret;
+       struct i2c_adapter *adap = client->adapter;
+       struct i2c_msg msg;
+       char tx_buf[4];
+
+       memcpy(tx_buf, reg, 2);
+       memcpy(tx_buf+2, data, 2);
+       msg.addr = client->addr;
+       msg.buf = tx_buf;
+       msg.len = 4;
+       msg.flags = client->flags;
+       msg.scl_rate = scl_rate;
+    
+       ret = i2c_transfer(adap, &msg, 1);
+
+       return ret;
+}
+
+int reg_recv_data(struct i2c_client *client, unsigned short *reg, unsigned short *buf, u32 scl_rate)
+{
+       int ret;
+       struct i2c_adapter *adap = client->adapter;
+       struct i2c_msg msgs[2];
+
+       msgs[0].addr = client->addr;
+       msgs[0].buf = (char *)reg;
+       msgs[0].flags = client->flags;
+       msgs[0].len = 2;
+       msgs[0].scl_rate = scl_rate;
+
+       msgs[1].addr = client->addr;
+       msgs[1].buf = (char *)buf;
+       msgs[1].flags = client->flags | I2C_M_RD;
+       msgs[1].len = 2;
+       msgs[1].scl_rate = scl_rate;
+
+       ret = i2c_transfer(adap, msgs, 2);
+
+       return ret;
+}
+
+#endif
+
+#if defined(CONFIG_SPI_MASTER)
+static int __devinit wm8994_spi_probe(struct spi_device *spi)
+{
+       struct wm8994_priv *wm8994;
+       struct snd_soc_codec *codec;
+
+       wm8994 = kzalloc(sizeof(struct wm8994_priv), GFP_KERNEL);
+       if (wm8994 == NULL)
+               return -ENOMEM;
+
+       codec = &wm8994->codec;
+       codec->control_data = spi;
+       codec->dev = &spi->dev;
+
+       dev_set_drvdata(&spi->dev, wm8994);
+
+       return wm8994_register(wm8994, SND_SOC_SPI);
+}
+
+static int __devexit wm8994_spi_remove(struct spi_device *spi)
+{
+       struct wm8994_priv *wm8994 = dev_get_drvdata(&spi->dev);
+
+       wm8994_unregister(wm8994);
+
+       return 0;
+}
+
+#ifdef CONFIG_PM
+static int wm8994_spi_suspend(struct spi_device *spi, pm_message_t msg)
+{
+       return snd_soc_suspend_device(&spi->dev);
+}
+
+static int wm8994_spi_resume(struct spi_device *spi)
+{
+       return snd_soc_resume_device(&spi->dev);
+}
+#else
+#define wm8994_spi_suspend NULL
+#define wm8994_spi_resume NULL
+#endif
+
+static struct spi_driver wm8994_spi_driver = {
+       .driver = {
+               .name   = "wm8994",
+               .bus    = &spi_bus_type,
+               .owner  = THIS_MODULE,
+       },
+       .probe          = wm8994_spi_probe,
+       .remove         = __devexit_p(wm8994_spi_remove),
+       .suspend        = wm8994_spi_suspend,
+       .resume         = wm8994_spi_resume,
+};
+#endif
+
+static int __init wm8994_modinit(void)
+{
+       int ret;
+
+#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
+       ret = i2c_add_driver(&wm8994_i2c_driver);
+       if (ret != 0)
+               pr_err("WM8994: Unable to register I2C driver: %d\n", ret);
+#endif
+#if defined(CONFIG_SPI_MASTER)
+       ret = spi_register_driver(&wm8994_spi_driver);
+       if (ret != 0)
+               pr_err("WM8994: Unable to register SPI driver: %d\n", ret);
+#endif
+       return ret;
+}
+module_init(wm8994_modinit);
+
+static void __exit wm8994_exit(void)
+{
+#if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
+       i2c_del_driver(&wm8994_i2c_driver);
+#endif
+#if defined(CONFIG_SPI_MASTER)
+       spi_unregister_driver(&wm8994_spi_driver);
+#endif
+}
+module_exit(wm8994_exit);
+
+
+MODULE_DESCRIPTION("ASoC WM8994 driver");
+MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
+MODULE_LICENSE("GPL");
+
diff --git a/sound/soc/codecs/wm8994.h b/sound/soc/codecs/wm8994.h
new file mode 100644 (file)
index 0000000..701630b
--- /dev/null
@@ -0,0 +1,60 @@
+/*
+ * Copyright 2005 Openedhand Ltd.
+ *
+ * Author: Richard Purdie <richard@openedhand.com>
+ *
+ * Based on WM8753.h
+ *
+ * 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.
+ *
+ */
+
+#ifndef _WM8994_H
+#define _WM8994_H
+
+/* WM8994 register space */
+
+#define WM8994_LINVOL    0x0f
+#define WM8994_RINVOL    0x01
+#define WM8994_LOUT1V    0x02
+#define WM8994_ROUT1V    0x03
+#define WM8994_ADCDAC    0x05
+#define WM8994_IFACE     0x07
+#define WM8994_SRATE     0x08
+#define WM8994_LDAC      0x0a
+#define WM8994_RDAC      0x0b
+#define WM8994_BASS      0x0c
+#define WM8994_TREBLE    0x0d
+#define WM8994_RESET     0x00
+#define WM8994_3D        0x10
+#define WM8994_ALC1      0x11
+#define WM8994_ALC2      0x12
+#define WM8994_ALC3      0x13
+#define WM8994_NGATE     0x14
+#define WM8994_LADC      0x15
+#define WM8994_RADC      0x16
+#define WM8994_ADCTL1    0x17
+#define WM8994_ADCTL2    0x18
+#define WM8994_PWR1      0x19
+#define WM8994_PWR2      0x1a
+#define WM8994_ADCTL3    0x1b
+#define WM8994_ADCIN     0x1f
+#define WM8994_LADCIN    0x20
+#define WM8994_RADCIN    0x21
+#define WM8994_LOUTM1    0x22
+#define WM8994_LOUTM2    0x23
+#define WM8994_ROUTM1    0x24
+#define WM8994_ROUTM2    0x25
+#define WM8994_LOUT2V    0x28
+#define WM8994_ROUT2V    0x29
+#define WM8994_LPPB      0x43
+#define WM8994_NUM_REG   0x44
+
+#define WM8994_SYSCLK  0
+
+extern struct snd_soc_dai wm8994_dai;
+extern struct snd_soc_codec_device soc_codec_dev_wm8994;
+
+#endif
index ae359b45d92ff63361b0824cca701984ae3541b2..c0830fbfd447024a292d1f278a0b7851151ac628 100755 (executable)
@@ -39,10 +39,10 @@ config SND_ROCKCHIP_SOC_RK1000
 if SND_ROCKCHIP_SOC_WM8988 || SND_ROCKCHIP_SOC_RK1000 || SND_ROCKCHIP_SOC_WM8994
 choice
   prompt "set i2s type"
-       config SND_ROCKCHIP_SOC_SLAVE
-               tristate "I2s run in slave Mode codec run in Master"
+       config SND_CODEC_SOC_MASTER
+               tristate "Codec run in Master"
 
-       config  SND_ROCKCHIP_SOC_MASTER
-               tristate  "I2s run in master Mode codec run in Master"
+       config SND_CODEC_SOC_SLAVE
+               tristate  "Codec run in Slave"
 endchoice
 endif
diff --git a/sound/soc/rk2818/rk2818_wm8994.c b/sound/soc/rk2818/rk2818_wm8994.c
new file mode 100755 (executable)
index 0000000..a4633d1
--- /dev/null
@@ -0,0 +1,186 @@
+/*
+ * rk2818_wm8988.c  --  SoC audio for rockchip
+ *
+ * Driver for rockchip wm8988 audio
+ *  Copyright (C) 2009 lhh
+ *
+ *  This program is free software; you can redistribute  it and/or modify it
+ *  under  the terms of  the GNU General  Public License as published by the
+ *  Free Software Foundation;  either version 2 of the  License, or (at your
+ *  option) any later version.
+ *
+ *
+ */
+
+#include <linux/module.h>
+#include <linux/device.h>
+#include <sound/core.h>
+#include <sound/pcm.h>
+#include <sound/soc.h>
+#include <sound/soc-dapm.h>
+#include <asm/io.h>
+#include <mach/hardware.h>
+#include <mach/rk2818_iomap.h>
+#include "../codecs/wm8994.h"
+#include "rk2818_pcm.h"
+#include "rk2818_i2s.h"
+
+#if 0
+#define        DBG(x...)       printk(KERN_INFO x)
+#else
+#define        DBG(x...)
+#endif
+
+static int rk2818_hw_params(struct snd_pcm_substream *substream,
+       struct snd_pcm_hw_params *params)
+{
+    struct snd_soc_pcm_runtime *rtd = substream->private_data;
+       struct snd_soc_dai *codec_dai = rtd->dai->codec_dai;
+       struct snd_soc_dai *cpu_dai = rtd->dai->cpu_dai;
+       int ret;
+         
+    DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);    
+       /*by Vincent Hsiung for EQ Vol Change*/
+       #define HW_PARAMS_FLAG_EQVOL_ON 0x21
+       #define HW_PARAMS_FLAG_EQVOL_OFF 0x22
+    if ((params->flags == HW_PARAMS_FLAG_EQVOL_ON)||(params->flags == HW_PARAMS_FLAG_EQVOL_OFF))
+    {
+       ret = codec_dai->ops->hw_params(substream, params, codec_dai); //by Vincent
+       DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
+    }
+    else
+    {
+           /* set codec DAI configuration */
+           #if defined (CONFIG_SND_ROCKCHIP_SOC_MASTER) 
+           ret = codec_dai->ops->set_fmt(codec_dai, SND_SOC_DAIFMT_I2S |
+               SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS); 
+           #endif      
+           #if defined (CONFIG_SND_ROCKCHIP_SOC_SLAVE) 
+           ret = codec_dai->ops->set_fmt(codec_dai, SND_SOC_DAIFMT_I2S |
+               SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBM_CFM ); 
+           #endif
+           if (ret < 0)
+                 return ret; 
+           /* set cpu DAI configuration */
+           #if defined (CONFIG_SND_ROCKCHIP_SOC_MASTER) 
+           ret = cpu_dai->ops->set_fmt(cpu_dai, SND_SOC_DAIFMT_I2S |
+               SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBM_CFM);
+           #endif      
+           #if defined (CONFIG_SND_ROCKCHIP_SOC_SLAVE) 
+           ret = cpu_dai->ops->set_fmt(cpu_dai, SND_SOC_DAIFMT_I2S |
+               SND_SOC_DAIFMT_NB_NF | SND_SOC_DAIFMT_CBS_CFS); 
+           #endif              
+           if (ret < 0)
+                 return ret;
+         }
+    
+         return 0;
+}
+
+static const struct snd_soc_dapm_widget rk2818_dapm_widgets[] = {
+       SND_SOC_DAPM_LINE("Audio Out", NULL),
+       SND_SOC_DAPM_LINE("Line in", NULL),
+       SND_SOC_DAPM_MIC("Micn", NULL),
+       SND_SOC_DAPM_MIC("Micp", NULL),
+};
+
+static const struct snd_soc_dapm_route audio_map[]= {
+       
+       {"Audio Out", NULL, "LOUT1"},
+       {"Audio Out", NULL, "ROUT1"},
+       {"Line in", NULL, "RINPUT1"},
+       {"Line in", NULL, "LINPUT1"},
+       {"Micn", NULL, "RINPUT2"},
+       {"Micp", NULL, "LINPUT2"},
+};
+
+/*
+ * Logic for a wm8994 as connected on a rockchip board.
+ */
+static int rk2818_wm8994_init(struct snd_soc_codec *codec)
+{
+       struct snd_soc_dai *codec_dai = &codec->dai[0];
+       int ret;
+
+    DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
+    
+    ret = snd_soc_dai_set_sysclk(codec_dai, 0,
+               12000000, SND_SOC_CLOCK_IN);
+       if (ret < 0) {
+               printk(KERN_ERR "Failed to set WM8994 SYSCLK: %d\n", ret);
+               return ret;
+       }
+       
+    /* Add specific widgets */
+       snd_soc_dapm_new_controls(codec, rk2818_dapm_widgets,
+                                 ARRAY_SIZE(rk2818_dapm_widgets));
+       snd_soc_dapm_nc_pin(codec, "LOUT2");
+       snd_soc_dapm_nc_pin(codec, "ROUT2");
+       
+    /* Set up specific audio path audio_mapnects */
+    snd_soc_dapm_add_routes(codec, audio_map, ARRAY_SIZE(audio_map));
+       
+    snd_soc_dapm_sync(codec);
+    return 0;
+}
+
+static struct snd_soc_ops rk2818_ops = {
+         .hw_params = rk2818_hw_params,
+};
+
+static struct snd_soc_dai_link rk2818_dai = {
+         .name = "WM8994",
+         .stream_name = "WM8994 PCM",
+         .cpu_dai = &rk2818_i2s_dai,
+         .codec_dai = &wm8994_dai,
+         .init = rk2818_wm8994_init,
+         .ops = &rk2818_ops,
+};
+
+static struct snd_soc_card snd_soc_card_rk2818 = {
+         .name = "RK2818_WM8994",
+         .platform = &rk2818_soc_platform,
+         .dai_link = &rk2818_dai,
+         .num_links = 1,
+};
+
+
+static struct snd_soc_device rk2818_snd_devdata = {
+         .card = &snd_soc_card_rk2818,
+         .codec_dev = &soc_codec_dev_wm8994,
+};
+
+static struct platform_device *rk2818_snd_device;
+
+static int __init audio_card_init(void)
+{
+       int ret =0;     
+    DBG("Enter::%s----%d\n",__FUNCTION__,__LINE__);
+
+       rk2818_snd_device = platform_device_alloc("soc-audio", -1);
+       if (!rk2818_snd_device) {
+                 DBG("platform device allocation failed\n");
+                 ret = -ENOMEM;
+                 return ret;
+       }
+       platform_set_drvdata(rk2818_snd_device, &rk2818_snd_devdata);
+       rk2818_snd_devdata.dev = &rk2818_snd_device->dev;
+       ret = platform_device_add(rk2818_snd_device);
+       if (ret) {
+           DBG("platform device add failed\n");
+           platform_device_put(rk2818_snd_device);
+       }
+       return ret;
+}
+static void __exit audio_card_exit(void)
+{
+       platform_device_unregister(rk2818_snd_device);
+}
+
+module_init(audio_card_init);
+module_exit(audio_card_exit);
+/* Module information */
+MODULE_AUTHOR("lhh lhh@rock-chips.com");
+MODULE_DESCRIPTION("ROCKCHIP i2s ASoC Interface");
+MODULE_LICENSE("GPL");