| /* drivers/i2c/chips/a1026.c - a1026 voice processor driver |
| * |
| * Copyright (C) 2009 HTC Corporation. |
| * |
| * 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. |
| * |
| */ |
| |
| #include <linux/interrupt.h> |
| #include <linux/i2c.h> |
| #include <linux/slab.h> |
| #include <linux/irq.h> |
| #include <linux/miscdevice.h> |
| #include <linux/gpio.h> |
| #include <linux/uaccess.h> |
| #include <linux/delay.h> |
| #include <linux/input.h> |
| #include <linux/workqueue.h> |
| #include <linux/freezer.h> |
| #include <linux/a1026.h> |
| |
| #define DEBUG (0) |
| #define ENABLE_DIAG_IOCTLS (0) |
| |
| static struct i2c_client *this_client; |
| static struct a1026_platform_data *pdata; |
| |
| static int execute_cmdmsg(unsigned int); |
| |
| static struct mutex a1026_lock; |
| static int a1026_opened; |
| static int a1026_suspended; |
| static int control_a1026_clk; |
| static unsigned int a1026_NS_state = A1026_NS_STATE_AUTO; |
| static int a1026_current_config = A1026_PATH_SUSPEND; |
| static int a1026_param_ID; |
| |
| struct vp_ctxt { |
| unsigned char *data; |
| unsigned int img_size; |
| }; |
| |
| struct vp_ctxt the_vp; |
| |
| static int a1026_i2c_read(char *rxData, int length) |
| { |
| int rc; |
| struct i2c_msg msgs[] = { |
| { |
| .addr = this_client->addr, |
| .flags = I2C_M_RD, |
| .len = length, |
| .buf = rxData, |
| }, |
| }; |
| |
| rc = i2c_transfer(this_client->adapter, msgs, 1); |
| if (rc < 0) { |
| pr_err("%s: transfer error %d\n", __func__, rc); |
| return rc; |
| } |
| |
| #if DEBUG |
| { |
| int i = 0; |
| for (i = 0; i < length; i++) |
| pr_info("%s: rx[%d] = %2x\n", __func__, i, rxData[i]); |
| } |
| #endif |
| |
| return 0; |
| } |
| |
| static int a1026_i2c_write(char *txData, int length) |
| { |
| int rc; |
| struct i2c_msg msg[] = { |
| { |
| .addr = this_client->addr, |
| .flags = 0, |
| .len = length, |
| .buf = txData, |
| }, |
| }; |
| |
| rc = i2c_transfer(this_client->adapter, msg, 1); |
| if (rc < 0) { |
| pr_err("%s: transfer error %d\n", __func__, rc); |
| return rc; |
| } |
| |
| #if DEBUG |
| { |
| int i = 0; |
| for (i = 0; i < length; i++) |
| pr_info("%s: tx[%d] = %2x\n", __func__, i, txData[i]); |
| } |
| #endif |
| |
| return 0; |
| } |
| |
| static int a1026_open(struct inode *inode, struct file *file) |
| { |
| int rc = 0; |
| struct vp_ctxt *vp = &the_vp; |
| |
| mutex_lock(&a1026_lock); |
| |
| if (a1026_opened) { |
| pr_err("%s: busy\n", __func__); |
| rc = -EBUSY; |
| goto done; |
| } |
| |
| file->private_data = vp; |
| vp->img_size = 0; |
| a1026_opened = 1; |
| done: |
| mutex_unlock(&a1026_lock); |
| return rc; |
| } |
| |
| static int a1026_release(struct inode *inode, struct file *file) |
| { |
| mutex_lock(&a1026_lock); |
| a1026_opened = 0; |
| mutex_unlock(&a1026_lock); |
| |
| return 0; |
| } |
| |
| static void a1026_i2c_sw_reset(unsigned int reset_cmd) |
| { |
| int rc = 0; |
| unsigned char msgbuf[4]; |
| |
| msgbuf[0] = (reset_cmd >> 24) & 0xFF; |
| msgbuf[1] = (reset_cmd >> 16) & 0xFF; |
| msgbuf[2] = (reset_cmd >> 8) & 0xFF; |
| msgbuf[3] = reset_cmd & 0xFF; |
| |
| pr_info("%s: %08x\n", __func__, reset_cmd); |
| |
| rc = a1026_i2c_write(msgbuf, 4); |
| if (!rc) |
| msleep(20); |
| } |
| |
| static ssize_t a1026_bootup_init(struct file *file, struct a1026img *img) |
| { |
| struct vp_ctxt *vp = file->private_data; |
| int rc, pass = 0; |
| int remaining; |
| int retry = RETRY_CNT; |
| unsigned char *index; |
| char buf[2]; |
| |
| if (img->img_size > A1026_MAX_FW_SIZE) { |
| pr_err("%s: invalid a1026 image size %d\n", __func__, |
| img->img_size); |
| return -EINVAL; |
| } |
| |
| vp->data = kmalloc(img->img_size, GFP_KERNEL); |
| if (!vp->data) { |
| pr_err("%s: out of memory\n", __func__); |
| return -ENOMEM; |
| } |
| vp->img_size = img->img_size; |
| if (copy_from_user(vp->data, img->buf, img->img_size)) { |
| pr_err("%s: copy from user failed\n", __func__); |
| kfree(vp->data); |
| return -EFAULT; |
| } |
| |
| while (retry--) { |
| /* Reset A1026 chip */ |
| gpio_set_value(pdata->gpio_a1026_reset, 0); |
| |
| /* Enable A1026 clock */ |
| if (control_a1026_clk) |
| gpio_set_value(pdata->gpio_a1026_clk, 1); |
| mdelay(1); |
| |
| /* Take out of reset */ |
| gpio_set_value(pdata->gpio_a1026_reset, 1); |
| |
| msleep(50); /* Delay before send I2C command */ |
| |
| /* Boot Cmd to A1026 */ |
| buf[0] = A1026_msg_BOOT >> 8; |
| buf[1] = A1026_msg_BOOT & 0xff; |
| |
| rc = a1026_i2c_write(buf, 2); |
| if (rc < 0) { |
| pr_err("%s: set boot mode error (%d retries left)\n", |
| __func__, retry); |
| continue; |
| } |
| |
| mdelay(1); /* use polling */ |
| rc = a1026_i2c_read(buf, 1); |
| if (rc < 0) { |
| pr_err("%s: boot mode ack error (%d retries left)\n", |
| __func__, retry); |
| continue; |
| } |
| |
| if (buf[0] != A1026_msg_BOOT_ACK) { |
| pr_err("%s: not a boot-mode ack (%d retries left)\n", |
| __func__, retry); |
| continue; |
| } |
| |
| remaining = vp->img_size / 32; |
| index = vp->data; |
| |
| pr_info("%s: starting to load image (%d passes)...\n", |
| __func__, |
| remaining + !!(vp->img_size % 32)); |
| |
| for (; remaining; remaining--, index += 32) { |
| rc = a1026_i2c_write(index, 32); |
| if (rc < 0) |
| break; |
| } |
| |
| if (rc >= 0 && vp->img_size % 32) |
| rc = a1026_i2c_write(index, vp->img_size % 32); |
| |
| if (rc < 0) { |
| pr_err("%s: fw load error %d (%d retries left)\n", |
| __func__, rc, retry); |
| continue; |
| } |
| |
| msleep(20); /* Delay time before issue a Sync Cmd */ |
| |
| pr_info("%s: firmware loaded successfully\n", __func__); |
| |
| rc = execute_cmdmsg(A100_msg_Sync); |
| if (rc < 0) { |
| pr_err("%s: sync command error %d (%d retries left)\n", |
| __func__, rc, retry); |
| continue; |
| } |
| |
| pass = 1; |
| break; |
| } |
| |
| /* Put A1026 into sleep mode */ |
| rc = execute_cmdmsg(A100_msg_Sleep); |
| if (rc < 0) { |
| pr_err("%s: suspend error\n", __func__); |
| goto set_suspend_err; |
| } |
| |
| a1026_suspended = 1; |
| a1026_current_config = A1026_PATH_SUSPEND; |
| |
| msleep(120); |
| /* Disable A1026 clock */ |
| if (control_a1026_clk) |
| gpio_set_value(pdata->gpio_a1026_clk, 0); |
| |
| set_suspend_err: |
| if (pass && !rc) |
| pr_info("%s: initialized!\n", __func__); |
| else |
| pr_err("%s: initialization failed\n", __func__); |
| |
| kfree(vp->data); |
| return rc; |
| } |
| |
| unsigned char phonecall_receiver[] = { |
| 0x80,0x17,0x00,0x02, /* SetAlgorithmParmID, 0x0002:Microphone Configuration */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:2-mic Close Talk (CT) */ |
| 0x80,0x1C,0x00,0x01, /* VoiceProcessingOn, 0x0001:Yes */ |
| 0x80,0x17,0x00,0x1A, /* SetAlgorithmParmID, 0x001A:Use ComfortNoise */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:No */ |
| 0x80,0x17,0x00,0x04, /* SetAlgorithmParmID, 0x0004:Use AGC */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:No */ |
| 0x80,0x17,0x00,0x00, /* SetAlgorithmParmID, 0x0000:Suppression Strength */ |
| 0x80,0x18,0x00,0x05, /* SetAlgorithmParm, 0x0005:25dB Max Suppression */ |
| 0x80,0x17,0x00,0x20, /* SetAlgorithmParmID, 0x0020:Tx PostEq Mode */ |
| 0x80,0x18,0x00,0x02, /* SetAlgorithmParm, 0x0002:On always */ |
| 0x80,0x1B,0x00,0x0C, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x0C:(12 dB) */ |
| 0x80,0x1B,0x01,0x0C, /* SetDigitalInputGain, 0x01:Secondary Mic (Tx), 0x0C:(12 dB) */ |
| 0x80,0x15,0x00,0xFA, /* SetDigitalOutputGain, 0x00:Tx, 0xFA:(-6 dB) */ |
| }; |
| |
| unsigned char phonecall_headset[] = { |
| 0x80,0x26,0x00,0x15, /* SelectRouting, 0x0015:Snk,Pri,Snk,Snk - Csp,Zro,Zro (none) */ |
| 0x80,0x1C,0x00,0x00, /* VoiceProcessingOn, 0x0000:No */ |
| 0x80,0x1B,0x00,0x12, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x12:(18 dB) */ |
| 0x80,0x15,0x00,0xF8, /* SetDigitalOutputGain, 0x00:Tx, 0xF8:(-8 dB) */ |
| }; |
| |
| unsigned char phonecall_speaker[] = { |
| 0x80,0x17,0x00,0x02, /* SetAlgorithmParmID, 0x0002:Microphone Configuration */ |
| 0x80,0x18,0x00,0x02, /* SetAlgorithmParm, 0x0002:1-mic Desktop/Vehicle (DV) */ |
| 0x80,0x1C,0x00,0x01, /* VoiceProcessingOn, 0x0001:Yes */ |
| 0x80,0x17,0x00,0x00, /* SetAlgorithmParmID, 0x0000:Suppression Strength */ |
| 0x80,0x18,0x00,0x02, /* SetAlgorithmParm, 0x0002 */ |
| 0x80,0x17,0x00,0x04, /* SetAlgorithmParmID, 0x0004:Use AGC */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:No */ |
| 0x80,0x17,0x00,0x1A, /* SetAlgorithmParmID, 0x001A:Use ComfortNoise */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:No */ |
| 0x80,0x1B,0x00,0x12, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x12:(18 dB) */ |
| 0x80,0x15,0x00,0xFD, /* SetDigitalOutputGain, 0x00:Tx, 0xFD:(-3 dB) */ |
| }; |
| |
| unsigned char phonecall_bt[] = { |
| 0x80,0x17,0x00,0x02, /* SetAlgorithmParmID, 0x0002:Microphone Configuration */ |
| 0x80,0x18,0x00,0x03, /* SetAlgorithmParm, 0x0003:1-mic External (MD) */ |
| 0x80,0x26,0x00,0x06, /* SelectRouting, 0x0006:Snk,Snk,Fei,Pri - Zro,Csp,Feo (PCM0->PCM1+ADCs) */ |
| 0x80,0x1C,0x00,0x00, /* VoiceProcessingOn, 0x0000:No */ |
| 0x80,0x1B,0x00,0x00, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x00:(0 dB) */ |
| 0x80,0x15,0x00,0x00, /* SetDigitalOutputGain, 0x00:Tx, 0x00:(0 dB) */ |
| }; |
| |
| unsigned char phonecall_tty[] = { |
| 0x80,0x26,0x00,0x15, /* SelectRouting, 0x0015:Snk,Pri,Snk,Snk - Csp,Zro,Zro (none) */ |
| 0x80,0x1C,0x00,0x00, /* VoiceProcessingOn, 0x0000:No */ |
| 0x80,0x1B,0x00,0x00, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x00:(0 dB) */ |
| 0x80,0x15,0x00,0xFB, /* SetDigitalOutputGain, 0x00:Tx, 0xFB:(-5 dB) */ |
| }; |
| |
| unsigned char INT_MIC_recording_receiver[] = { |
| 0x80,0x26,0x00,0x07, /* SelectRouting, 0x0007:Pri,Snk,Snk,Snk - Csp,Zro,Zro (none) */ |
| 0x80,0x1C,0x00,0x00, /* VoiceProcessingOn, 0x0000:No */ |
| 0x80,0x1B,0x00,0x12, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x12:(18 dB) */ |
| 0x80,0x15,0x00,0x00, /* SetDigitalOutputGain, 0x00:Tx, 0x00:(0 dB) */ |
| }; |
| |
| unsigned char EXT_MIC_recording[] = { |
| 0x80,0x26,0x00,0x15, /* SelectRouting, 0x0015:Snk,Pri,Snk,Snk - Csp,Zro,Zro (none) */ |
| 0x80,0x1C,0x00,0x00, /* VoiceProcessingOn, 0x0000:No */ |
| 0x80,0x1B,0x00,0x12, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x12:(18 dB) */ |
| 0x80,0x15,0x00,0x00, /* SetDigitalOutputGain, 0x00:Tx, 0x00:(0 dB) */ |
| }; |
| |
| unsigned char INT_MIC_recording_speaker[] = { |
| 0x80,0x17,0x00,0x02, /* SetAlgorithmParmID, 0x0002:Microphone Configuration */ |
| 0x80,0x18,0x00,0x02, /* SetAlgorithmParm, 0x0002:1-mic Desktop/Vehicle (DV) */ |
| 0x80,0x1C,0x00,0x00, /* VoiceProcessingOn, 0x0000:No */ |
| 0x80,0x1B,0x00,0x12, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x12:(18 dB) */ |
| 0x80,0x15,0x00,0x00, /* SetDigitalOutputGain, 0x00:Tx, 0x00:(0 dB) */ |
| }; |
| |
| unsigned char BACK_MIC_recording[] = { |
| 0x80,0x17,0x00,0x02, /* SetAlgorithmParmID, 0x0002:Microphone Configuration */ |
| 0x80,0x18,0x00,0x02, /* SetAlgorithmParm, 0x0002:1-mic Desktop/Vehicle (DV) */ |
| 0x80,0x26,0x00,0x15, /* SelectRouting, 0x0015:Snk,Pri,Snk,Snk - Csp,Zro,Zro (none) */ |
| 0x80,0x1C,0x00,0x01, /* VoiceProcessingOn, 0x0001:Yes */ |
| 0x80,0x17,0x00,0x04, /* SetAlgorithmParmID, 0x0004:Use AGC */ |
| 0x80,0x18,0x00,0x01, /* SetAlgorithmParm, 0x0001:Yes */ |
| 0x80,0x17,0x00,0x1A, /* SetAlgorithmParmID, 0x001A:Use ComfortNoise */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:No */ |
| 0x80,0x17,0x00,0x00, /* SetAlgorithmParmID, 0x0000:Suppression Strength */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:No Suppression */ |
| 0x80,0x1B,0x00,0x12, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x12:(18 dB) */ |
| 0x80,0x15,0x00,0x06, /* SetDigitalOutputGain, 0x00:Tx, 0x06:(6 dB) */ |
| }; |
| |
| unsigned char vr_no_ns_receiver[] = { |
| 0x80,0x17,0x00,0x02, /* SetAlgorithmParmID, 0x0002:Microphone Configuration */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:2-mic Close Talk (CT) */ |
| 0x80,0x1C,0x00,0x00, /* VoiceProcessingOn, 0x0000:No */ |
| 0x80,0x1B,0x00,0x0C, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x0C:(12 dB) */ |
| 0x80,0x1B,0x01,0x0C, /* SetDigitalInputGain, 0x01:Secondary Mic (Tx), 0x09:(12 dB) */ |
| 0x80,0x15,0x00,0x00, /* SetDigitalOutputGain, 0x00:Tx, 0x00:(0 dB) */ |
| }; |
| |
| unsigned char vr_no_ns_headset[] = { |
| 0x80,0x17,0x00,0x02, /* SetAlgorithmParmID, 0x0002:Microphone Configuration */ |
| 0x80,0x18,0x00,0x03, /* SetAlgorithmParm, 0x0003:1M-DG (1-mic digital input) */ |
| 0x80,0x26,0x00,0x15, /* SelectRouting, 0x0015:Snk,Pri,Snk,Snk - Csp,Zro,Zro (none) */ |
| 0x80,0x1C,0x00,0x00, /* VoiceProcessingOn, 0x0000:No */ |
| 0x80,0x1B,0x00,0x12, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x12:(18 dB) */ |
| 0x80,0x15,0x00,0x00, /* SetDigitalOutputGain, 0x00:Tx, 0x00:(0 dB) */ |
| }; |
| |
| unsigned char vr_no_ns_speaker[] = { |
| 0x80,0x17,0x00,0x02, /* SetAlgorithmParmID, 0x0002:Microphone Configuration */ |
| 0x80,0x18,0x00,0x02, /* SetAlgorithmParm, 0x0002:1-mic Desktop/Vehicle (DV) */ |
| 0x80,0x1C,0x00,0x00, /* VoiceProcessingOn, 0x0000:No */ |
| 0x80,0x1B,0x00,0x0C, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x0C:(12 dB) */ |
| 0x80,0x15,0x00,0x00, /* SetDigitalOutputGain, 0x00:Tx, 0x00:(0 dB) */ |
| }; |
| |
| unsigned char vr_no_ns_bt[] = { |
| 0x80,0x26,0x00,0x06, /* SelectRouting, 0x0006:Snk,Snk,Fei,Pri - Zro,Csp,Feo (PCM0->PCM1+ADCs) */ |
| 0x80,0x1C,0x00,0x00, /* VoiceProcessingOn, 0x0000:No */ |
| 0x80,0x1B,0x00,0x00, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x00:(0 dB) */ |
| 0x80,0x15,0x00,0x00, /* SetDigitalOutputGain, 0x00:Tx, 0x00:(0 dB) */ |
| }; |
| |
| unsigned char vr_ns_receiver[] = { |
| 0x80,0x17,0x00,0x02, /* SetAlgorithmParmID, 0x0002:Microphone Configuration */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:2-mic Close Talk (CT) */ |
| 0x80,0x1C,0x00,0x01, /* VoiceProcessingOn, 0x0001:Yes */ |
| 0x80,0x17,0x00,0x1A, /* SetAlgorithmParmID, 0x001A:Use ComfortNoise */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:No */ |
| 0x80,0x17,0x00,0x04, /* SetAlgorithmParmID, 0x0004:Use AGC */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:No */ |
| 0x80,0x17,0x00,0x00, /* SetAlgorithmParmID, 0x0000:Suppression Strength */ |
| 0x80,0x18,0x00,0x04, /* SetAlgorithmParm, 0x0004:20dB Max Suppression */ |
| 0x80,0x1B,0x00,0x0C, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x0C:(12 dB) */ |
| 0x80,0x1B,0x01,0x0C, /* SetDigitalInputGain, 0x01:Secondary Mic (Tx), 0x0C:(12 dB) */ |
| 0x80,0x15,0x00,0x00, /* SetDigitalOutputGain, 0x00:Tx, 0x00:(0 dB) */ |
| }; |
| |
| unsigned char vr_ns_headset[] = { |
| 0x80,0x17,0x00,0x02, /* SetAlgorithmParmID, 0x0002:Microphone Configuration */ |
| 0x80,0x18,0x00,0x03, /* SetAlgorithmParm, 0x0003:1-mic External (MD) */ |
| 0x80,0x26,0x00,0x15, /* SelectRouting, 0x0015:Snk,Pri,Snk,Snk - Csp,Zro,Zro (none) */ |
| 0x80,0x1C,0x00,0x01, /* VoiceProcessingOn, 0x0001:Yes */ |
| 0x80,0x17,0x00,0x00, /* SetAlgorithmParmID, 0x0000:Suppression Strength */ |
| 0x80,0x18,0x00,0x02, /* SetAlgorithmParm, 0x0002:20dB Max Suppression */ |
| 0x80,0x17,0x00,0x1A, /* SetAlgorithmParmID, 0x001A:Use ComfortNoise */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:No */ |
| 0x80,0x17,0x00,0x04, /* SetAlgorithmParmID, 0x0004:Use AGC */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:No */ |
| 0x80,0x1B,0x00,0x12, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x12:(18 dB) */ |
| 0x80,0x15,0x00,0x00, /* SetDigitalOutputGain, 0x00:Tx, 0x00:(0 dB) */ |
| }; |
| |
| unsigned char vr_ns_speaker[] = { |
| 0x80,0x17,0x00,0x02, /* SetAlgorithmParmID, 0x0002:Microphone Configuration */ |
| 0x80,0x18,0x00,0x02, /* SetAlgorithmParm, 0x0002:1-mic Desktop/Vehicle (DV) */ |
| 0x80,0x1C,0x00,0x01, /* VoiceProcessingOn, 0x0001:Yes */ |
| 0x80,0x17,0x00,0x00, /* SetAlgorithmParmID, 0x0000:Suppression Strength */ |
| 0x80,0x18,0x00,0x04, /* SetAlgorithmParm, 0x0004:20dB Max Suppression */ |
| 0x80,0x17,0x00,0x04, /* SetAlgorithmParmID, 0x0004:Use AGC */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:No */ |
| 0x80,0x17,0x00,0x1A, /* SetAlgorithmParmID, 0x001A:Use ComfortNoise */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:No */ |
| 0x80,0x1B,0x00,0x0C, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x0C:(12 dB) */ |
| 0x80,0x15,0x00,0x00, /* SetDigitalOutputGain, 0x00:Tx, 0x00:(0 dB) */ |
| }; |
| |
| unsigned char vr_ns_bt[] = { |
| 0x80,0x26,0x00,0x06, /* SelectRouting, 0x0006:Snk,Snk,Fei,Pri - Zro,Csp,Feo (PCM0->PCM1+ADCs) */ |
| 0x80,0x1C,0x00,0x01, /* VoiceProcessingOn, 0x0001:Yes */ |
| 0x80,0x17,0x00,0x00, /* SetAlgorithmParmID, 0x0000:Suppression Strength */ |
| 0x80,0x18,0x00,0x02, /* SetAlgorithmParm, 0x0002:20dB Max Suppression */ |
| 0x80,0x17,0x00,0x04, /* SetAlgorithmParmID, 0x0004:Use AGC */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:No */ |
| 0x80,0x17,0x00,0x1A, /* SetAlgorithmParmID, 0x001A:Use ComfortNoise */ |
| 0x80,0x18,0x00,0x00, /* SetAlgorithmParm, 0x0000:No */ |
| 0x80,0x1B,0x00,0x00, /* SetDigitalInputGain, 0x00:Primay Mic (Tx), 0x00:(0 dB) */ |
| 0x80,0x15,0x00,0x00, /* SetDigitalOutputGain, 0x00:Tx, 0x00:(0 dB) */ |
| }; |
| |
| unsigned char suspend_mode[] = { |
| 0x80,0x10,0x00,0x01 |
| }; |
| |
| static ssize_t chk_wakeup_a1026(void) |
| { |
| int rc = 0, retry = 3; |
| |
| if (a1026_suspended == 1) { |
| /* Enable A1026 clock */ |
| if (control_a1026_clk) { |
| gpio_set_value(pdata->gpio_a1026_clk, 1); |
| mdelay(1); |
| } |
| |
| gpio_set_value(pdata->gpio_a1026_wakeup, 0); |
| msleep(120); |
| |
| do { |
| rc = execute_cmdmsg(A100_msg_Sync); |
| } while ((rc < 0) && --retry); |
| |
| gpio_set_value(pdata->gpio_a1026_wakeup, 1); |
| if (rc < 0) { |
| pr_err("%s: failed (%d)\n", __func__, rc); |
| goto wakeup_sync_err; |
| } |
| |
| a1026_suspended = 0; |
| } |
| wakeup_sync_err: |
| return rc; |
| } |
| |
| /* Filter commands according to noise suppression state forced by |
| * A1026_SET_NS_STATE ioctl. |
| * |
| * For this function to operate properly, all configurations must include |
| * both A100_msg_Bypass and Mic_Config commands even if default values |
| * are selected or if Mic_Config is useless because VP is off |
| */ |
| int a1026_filter_vp_cmd(int cmd, int mode) |
| { |
| int msg = (cmd >> 16) & 0xFFFF; |
| int filtered_cmd = cmd; |
| |
| if (a1026_NS_state == A1026_NS_STATE_AUTO) |
| return cmd; |
| |
| switch (msg) { |
| case A100_msg_Bypass: |
| if (a1026_NS_state == A1026_NS_STATE_OFF) |
| filtered_cmd = A1026_msg_VP_OFF; |
| else |
| filtered_cmd = A1026_msg_VP_ON; |
| break; |
| case A100_msg_SetAlgorithmParmID: |
| a1026_param_ID = cmd & 0xFFFF; |
| break; |
| case A100_msg_SetAlgorithmParm: |
| if (a1026_param_ID == Mic_Config) { |
| if (a1026_NS_state == A1026_NS_STATE_CT) |
| filtered_cmd = (msg << 16); |
| else if (a1026_NS_state == A1026_NS_STATE_FT) |
| filtered_cmd = (msg << 16) | 0x0002; |
| } |
| break; |
| default: |
| if (mode == A1026_CONFIG_VP) |
| filtered_cmd = -1; |
| break; |
| } |
| |
| pr_info("%s: %x filtered = %x, a1026_NS_state %d, mode %d\n", __func__, |
| cmd, filtered_cmd, a1026_NS_state, mode); |
| |
| return filtered_cmd; |
| } |
| |
| int a1026_set_config(char newid, int mode) |
| { |
| int i = 0, rc = 0, size = 0; |
| int number_of_cmd_sets, rd_retry_cnt; |
| unsigned int sw_reset = 0; |
| unsigned char *i2c_cmds; |
| unsigned char *index = 0; |
| unsigned char ack_buf[A1026_CMD_FIFO_DEPTH * 4]; |
| unsigned char rdbuf[4]; |
| |
| if ((a1026_suspended) && (newid == A1026_PATH_SUSPEND)) |
| return rc; |
| |
| rc = chk_wakeup_a1026(); |
| if (rc < 0) |
| return rc; |
| |
| sw_reset = ((A100_msg_Reset << 16) | RESET_IMMEDIATE); |
| |
| switch (newid) { |
| case A1026_PATH_INCALL_RECEIVER: |
| gpio_set_value(pdata->gpio_a1026_micsel, 0); |
| i2c_cmds = phonecall_receiver; |
| size = sizeof(phonecall_receiver); |
| break; |
| case A1026_PATH_INCALL_HEADSET: |
| gpio_set_value(pdata->gpio_a1026_micsel, 1); |
| i2c_cmds = phonecall_headset; |
| size = sizeof(phonecall_headset); |
| break; |
| case A1026_PATH_INCALL_SPEAKER: |
| gpio_set_value(pdata->gpio_a1026_micsel, 0); |
| i2c_cmds = phonecall_speaker; |
| size = sizeof(phonecall_speaker); |
| break; |
| case A1026_PATH_INCALL_BT: |
| gpio_set_value(pdata->gpio_a1026_micsel, 0); |
| i2c_cmds = phonecall_bt; |
| size = sizeof(phonecall_bt); |
| break; |
| case A1026_PATH_INCALL_TTY: |
| gpio_set_value(pdata->gpio_a1026_micsel, 1); |
| i2c_cmds = phonecall_tty; |
| size = sizeof(phonecall_tty); |
| break; |
| case A1026_PATH_VR_NO_NS_RECEIVER: |
| gpio_set_value(pdata->gpio_a1026_micsel, 0); |
| i2c_cmds = vr_no_ns_receiver; |
| size = sizeof(vr_no_ns_receiver); |
| break; |
| case A1026_PATH_VR_NO_NS_HEADSET: |
| gpio_set_value(pdata->gpio_a1026_micsel, 1); |
| i2c_cmds = vr_no_ns_headset; |
| size = sizeof(vr_no_ns_headset); |
| break; |
| case A1026_PATH_VR_NO_NS_SPEAKER: |
| gpio_set_value(pdata->gpio_a1026_micsel, 0); |
| i2c_cmds = vr_no_ns_speaker; |
| size = sizeof(vr_no_ns_speaker); |
| break; |
| case A1026_PATH_VR_NO_NS_BT: |
| gpio_set_value(pdata->gpio_a1026_micsel, 0); |
| i2c_cmds = vr_no_ns_bt; |
| size = sizeof(vr_no_ns_bt); |
| break; |
| case A1026_PATH_VR_NS_RECEIVER: |
| gpio_set_value(pdata->gpio_a1026_micsel, 0); |
| i2c_cmds = vr_ns_receiver; |
| size = sizeof(vr_ns_receiver); |
| break; |
| case A1026_PATH_VR_NS_HEADSET: |
| gpio_set_value(pdata->gpio_a1026_micsel, 1); |
| i2c_cmds = vr_ns_headset; |
| size = sizeof(vr_ns_headset); |
| break; |
| case A1026_PATH_VR_NS_SPEAKER: |
| gpio_set_value(pdata->gpio_a1026_micsel, 0); |
| i2c_cmds = vr_ns_speaker; |
| size = sizeof(vr_ns_speaker); |
| break; |
| case A1026_PATH_VR_NS_BT: |
| gpio_set_value(pdata->gpio_a1026_micsel, 0); |
| i2c_cmds = vr_ns_bt; |
| size = sizeof(vr_ns_bt); |
| break; |
| case A1026_PATH_RECORD_RECEIVER: |
| gpio_set_value(pdata->gpio_a1026_micsel, 0); |
| i2c_cmds = INT_MIC_recording_receiver; |
| size = sizeof(INT_MIC_recording_receiver); |
| break; |
| case A1026_PATH_RECORD_HEADSET: |
| gpio_set_value(pdata->gpio_a1026_micsel, 1); |
| i2c_cmds = EXT_MIC_recording; |
| size = sizeof(EXT_MIC_recording); |
| break; |
| case A1026_PATH_RECORD_SPEAKER: |
| gpio_set_value(pdata->gpio_a1026_micsel, 0); |
| i2c_cmds = INT_MIC_recording_speaker; |
| size = sizeof(INT_MIC_recording_speaker); |
| break; |
| case A1026_PATH_RECORD_BT: |
| gpio_set_value(pdata->gpio_a1026_micsel, 0); |
| i2c_cmds = phonecall_bt; |
| size = sizeof(phonecall_bt); |
| break; |
| case A1026_PATH_SUSPEND: |
| gpio_set_value(pdata->gpio_a1026_micsel, 0); |
| i2c_cmds = (unsigned char *)suspend_mode; |
| size = sizeof(suspend_mode); |
| break; |
| case A1026_PATH_CAMCORDER: |
| gpio_set_value(pdata->gpio_a1026_micsel, 0); |
| i2c_cmds = BACK_MIC_recording; |
| size = sizeof(BACK_MIC_recording); |
| break; |
| default: |
| pr_err("%s: invalid cmd %d\n", __func__, newid); |
| rc = -1; |
| goto input_err; |
| break; |
| } |
| |
| a1026_current_config = newid; |
| pr_info("%s: change to mode %d\n", __func__, newid); |
| |
| pr_info("%s: block write start (size = %d)\n", __func__, size); |
| #if DEBUG |
| for (i = 1; i <= size; i++) { |
| pr_info("%x ", *(i2c_cmds + i - 1)); |
| if ( !(i % 4)) |
| pr_info("\n"); |
| } |
| #endif |
| |
| rc = a1026_i2c_write(i2c_cmds, size); |
| if (rc < 0) { |
| pr_err("A1026 CMD block write error!\n"); |
| a1026_i2c_sw_reset(sw_reset); |
| return rc; |
| } |
| pr_info("%s: block write end\n", __func__); |
| |
| /* Don't need to get Ack after sending out a suspend command */ |
| if (*i2c_cmds == 0x80 && *(i2c_cmds + 1) == 0x10 |
| && *(i2c_cmds + 2) == 0x00 && *(i2c_cmds + 3) == 0x01) { |
| a1026_suspended = 1; |
| /* Disable A1026 clock */ |
| msleep(120); |
| if (control_a1026_clk) |
| gpio_set_value(pdata->gpio_a1026_clk, 0); |
| return rc; |
| } |
| |
| memset(ack_buf, 0, sizeof(ack_buf)); |
| msleep(20); |
| pr_info("%s: CMD ACK block read start\n", __func__); |
| rc = a1026_i2c_read(ack_buf, size); |
| if (rc < 0) { |
| pr_err("%s: CMD ACK block read error\n", __func__); |
| a1026_i2c_sw_reset(sw_reset); |
| return rc; |
| } else { |
| pr_info("%s: CMD ACK block read end\n", __func__); |
| #if DEBUG |
| for (i = 1; i <= size; i++) { |
| pr_info("%x ", ack_buf[i-1]); |
| if ( !(i % 4)) |
| pr_info("\n"); |
| } |
| #endif |
| index = ack_buf; |
| number_of_cmd_sets = size / 4; |
| do { |
| if (*index == 0x00) { |
| rd_retry_cnt = POLLING_RETRY_CNT; |
| rd_retry: |
| if (rd_retry_cnt--) { |
| memset(rdbuf, 0, sizeof(rdbuf)); |
| rc = a1026_i2c_read(rdbuf, 4); |
| if (rc < 0) |
| return rc; |
| #if DEBUG |
| for (i = 0; i < sizeof(rdbuf); i++) { |
| pr_info("0x%x\n", rdbuf[i]); |
| } |
| pr_info("-----------------\n"); |
| #endif |
| if (rdbuf[0] == 0x00) { |
| msleep(20); |
| goto rd_retry; |
| } |
| } else { |
| pr_err("%s: CMD ACK Not Ready\n", |
| __func__); |
| return -EBUSY; |
| } |
| } else if (*index == 0xff) { /* illegal cmd */ |
| return -ENOEXEC; |
| } else if (*index == 0x80) { |
| index += 4; |
| } |
| } while (--number_of_cmd_sets); |
| } |
| input_err: |
| return rc; |
| } |
| |
| int execute_cmdmsg(unsigned int msg) |
| { |
| int rc = 0; |
| int retries, pass = 0; |
| unsigned char msgbuf[4]; |
| unsigned char chkbuf[4]; |
| unsigned int sw_reset = 0; |
| |
| sw_reset = ((A100_msg_Reset << 16) | RESET_IMMEDIATE); |
| |
| msgbuf[0] = (msg >> 24) & 0xFF; |
| msgbuf[1] = (msg >> 16) & 0xFF; |
| msgbuf[2] = (msg >> 8) & 0xFF; |
| msgbuf[3] = msg & 0xFF; |
| |
| memcpy(chkbuf, msgbuf, 4); |
| |
| rc = a1026_i2c_write(msgbuf, 4); |
| if (rc < 0) { |
| pr_err("%s: error %d\n", __func__, rc); |
| a1026_i2c_sw_reset(sw_reset); |
| return rc; |
| } |
| |
| /* We don't need to get Ack after sending out a suspend command */ |
| if (msg == A100_msg_Sleep) |
| return rc; |
| |
| retries = POLLING_RETRY_CNT; |
| while (retries--) { |
| rc = 0; |
| |
| msleep(20); /* use polling */ |
| memset(msgbuf, 0, sizeof(msgbuf)); |
| rc = a1026_i2c_read(msgbuf, 4); |
| if (rc < 0) { |
| pr_err("%s: ack-read error %d (%d retries)\n", __func__, |
| rc, retries); |
| continue; |
| } |
| |
| if (msgbuf[0] == 0x80 && msgbuf[1] == chkbuf[1]) { |
| pass = 1; |
| break; |
| } else if (msgbuf[0] == 0xff && msgbuf[1] == 0xff) { |
| pr_err("%s: illegal cmd %08x\n", __func__, msg); |
| rc = -EINVAL; |
| break; |
| } else if ( msgbuf[0] == 0x00 && msgbuf[1] == 0x00 ) { |
| pr_info("%s: not ready (%d retries)\n", __func__, |
| retries); |
| rc = -EBUSY; |
| } else { |
| pr_info("%s: cmd/ack mismatch: (%d retries left)\n", |
| __func__, |
| retries); |
| #if DEBUG |
| pr_info("%s: msgbuf[0] = %x\n", __func__, msgbuf[0]); |
| pr_info("%s: msgbuf[1] = %x\n", __func__, msgbuf[1]); |
| pr_info("%s: msgbuf[2] = %x\n", __func__, msgbuf[2]); |
| pr_info("%s: msgbuf[3] = %x\n", __func__, msgbuf[3]); |
| #endif |
| rc = -EBUSY; |
| } |
| } |
| |
| if (!pass) { |
| pr_err("%s: failed execute cmd %08x (%d)\n", __func__, |
| msg, rc); |
| a1026_i2c_sw_reset(sw_reset); |
| } |
| return rc; |
| } |
| |
| #if ENABLE_DIAG_IOCTLS |
| static int a1026_set_mic_state(char miccase) |
| { |
| int rc = 0; |
| unsigned int cmd_msg = 0; |
| |
| switch (miccase) { |
| case 1: /* Mic-1 ON / Mic-2 OFF */ |
| cmd_msg = 0x80260007; |
| break; |
| case 2: /* Mic-1 OFF / Mic-2 ON */ |
| cmd_msg = 0x80260015; |
| break; |
| case 3: /* both ON */ |
| cmd_msg = 0x80260001; |
| break; |
| case 4: /* both OFF */ |
| cmd_msg = 0x80260006; |
| break; |
| default: |
| pr_info("%s: invalid input %d\n", __func__, miccase); |
| rc = -EINVAL; |
| break; |
| } |
| rc = execute_cmdmsg(cmd_msg); |
| return rc; |
| } |
| |
| static int exe_cmd_in_file(unsigned char *incmd) |
| { |
| int rc = 0; |
| int i = 0; |
| unsigned int cmd_msg = 0; |
| unsigned char tmp = 0; |
| |
| for (i = 0; i < 4; i++) { |
| tmp = *(incmd + i); |
| cmd_msg |= (unsigned int)tmp; |
| if (i != 3) |
| cmd_msg = cmd_msg << 8; |
| } |
| rc = execute_cmdmsg(cmd_msg); |
| if (rc < 0) |
| pr_err("%s: cmd %08x error %d\n", __func__, cmd_msg, rc); |
| return rc; |
| } |
| #endif /* ENABLE_DIAG_IOCTLS */ |
| |
| static int |
| a1026_ioctl(struct inode *inode, struct file *file, unsigned int cmd, |
| unsigned long arg) |
| { |
| void __user *argp = (void __user *)arg; |
| struct a1026img img; |
| int rc = 0; |
| #if ENABLE_DIAG_IOCTLS |
| char msg[4]; |
| int mic_cases = 0; |
| int mic_sel = 0; |
| #endif |
| int pathid = 0; |
| unsigned int ns_state; |
| |
| switch (cmd) { |
| case A1026_BOOTUP_INIT: |
| img.buf = 0; |
| img.img_size = 0; |
| if (copy_from_user(&img, argp, sizeof(img))) |
| return -EFAULT; |
| rc = a1026_bootup_init(file, &img); |
| break; |
| case A1026_SET_CONFIG: |
| if (copy_from_user(&pathid, argp, sizeof(pathid))) |
| return -EFAULT; |
| rc = a1026_set_config(pathid, A1026_CONFIG_FULL); |
| if (rc < 0) |
| pr_err("%s: A1026_SET_CONFIG (%d) error %d!\n", |
| __func__, pathid, rc); |
| break; |
| case A1026_SET_NS_STATE: |
| if (copy_from_user(&ns_state, argp, sizeof(ns_state))) |
| return -EFAULT; |
| pr_info("%s: set noise suppression %d\n", __func__, ns_state); |
| if (ns_state < 0 || ns_state >= A1026_NS_NUM_STATES) |
| return -EINVAL; |
| a1026_NS_state = ns_state; |
| if (!a1026_suspended) |
| a1026_set_config(a1026_current_config, |
| A1026_CONFIG_VP); |
| break; |
| #if ENABLE_DIAG_IOCTLS |
| case A1026_SET_MIC_ONOFF: |
| rc = chk_wakeup_a1026(); |
| if (rc < 0) |
| return rc; |
| if (copy_from_user(&mic_cases, argp, sizeof(mic_cases))) |
| return -EFAULT; |
| rc = a1026_set_mic_state(mic_cases); |
| if (rc < 0) |
| pr_err("%s: A1026_SET_MIC_ONOFF %d error %d!\n", |
| __func__, mic_cases, rc); |
| break; |
| case A1026_SET_MICSEL_ONOFF: |
| rc = chk_wakeup_a1026(); |
| if (rc < 0) |
| return rc; |
| if (copy_from_user(&mic_sel, argp, sizeof(mic_sel))) |
| return -EFAULT; |
| gpio_set_value(pdata->gpio_a1026_micsel, !!mic_sel); |
| rc = 0; |
| break; |
| case A1026_READ_DATA: |
| rc = chk_wakeup_a1026(); |
| if (rc < 0) |
| return rc; |
| rc = a1026_i2c_read(msg, 4); |
| if (copy_to_user(argp, &msg, 4)) |
| return -EFAULT; |
| break; |
| case A1026_WRITE_MSG: |
| rc = chk_wakeup_a1026(); |
| if (rc < 0) |
| return rc; |
| if (copy_from_user(msg, argp, sizeof(msg))) |
| return -EFAULT; |
| rc = a1026_i2c_write(msg, 4); |
| break; |
| case A1026_SYNC_CMD: |
| rc = chk_wakeup_a1026(); |
| if (rc < 0) |
| return rc; |
| msg[0] = 0x80; |
| msg[1] = 0x00; |
| msg[2] = 0x00; |
| msg[3] = 0x00; |
| rc = a1026_i2c_write(msg, 4); |
| break; |
| case A1026_SET_CMD_FILE: |
| rc = chk_wakeup_a1026(); |
| if (rc < 0) |
| return rc; |
| if (copy_from_user(msg, argp, sizeof(msg))) |
| return -EFAULT; |
| rc = exe_cmd_in_file(msg); |
| break; |
| #endif /* ENABLE_DIAG_IOCTLS */ |
| default: |
| pr_err("%s: invalid command %d\n", __func__, _IOC_NR(cmd)); |
| rc = -EINVAL; |
| break; |
| } |
| |
| return rc; |
| } |
| |
| static const struct file_operations a1026_fops = { |
| .owner = THIS_MODULE, |
| .open = a1026_open, |
| .release = a1026_release, |
| .ioctl = a1026_ioctl, |
| }; |
| |
| static struct miscdevice a1026_device = { |
| .minor = MISC_DYNAMIC_MINOR, |
| .name = "audience_a1026", |
| .fops = &a1026_fops, |
| }; |
| |
| static int a1026_probe( |
| struct i2c_client *client, const struct i2c_device_id *id) |
| { |
| int rc = 0; |
| |
| pdata = client->dev.platform_data; |
| |
| if (pdata == NULL) { |
| pdata = kzalloc(sizeof(*pdata), GFP_KERNEL); |
| if (pdata == NULL) { |
| rc = -ENOMEM; |
| pr_err("%s: platform data is NULL\n", __func__); |
| goto err_alloc_data_failed; |
| } |
| } |
| |
| this_client = client; |
| |
| rc = gpio_request(pdata->gpio_a1026_clk, "a1026"); |
| if (rc < 0) { |
| control_a1026_clk = 0; |
| goto chk_gpio_micsel; |
| } |
| control_a1026_clk = 1; |
| |
| rc = gpio_direction_output(pdata->gpio_a1026_clk, 1); |
| if (rc < 0) { |
| pr_err("%s: request clk gpio direction failed\n", __func__); |
| goto err_free_gpio_clk; |
| } |
| |
| chk_gpio_micsel: |
| rc = gpio_request(pdata->gpio_a1026_micsel, "a1026"); |
| if (rc < 0) { |
| pr_err("%s: gpio request mic_sel pin failed\n", __func__); |
| goto err_free_gpio_micsel; |
| } |
| |
| rc = gpio_direction_output(pdata->gpio_a1026_micsel, 1); |
| if (rc < 0) { |
| pr_err("%s: request mic_sel gpio direction failed\n", __func__); |
| goto err_free_gpio_micsel; |
| } |
| |
| rc = gpio_request(pdata->gpio_a1026_wakeup, "a1026"); |
| if (rc < 0) { |
| pr_err("%s: gpio request wakeup pin failed\n", __func__); |
| goto err_free_gpio; |
| } |
| |
| rc = gpio_direction_output(pdata->gpio_a1026_wakeup, 1); |
| if (rc < 0) { |
| pr_err("%s: request wakeup gpio direction failed\n", __func__); |
| goto err_free_gpio; |
| } |
| |
| rc = gpio_request(pdata->gpio_a1026_reset, "a1026"); |
| if (rc < 0) { |
| pr_err("%s: gpio request reset pin failed\n", __func__); |
| goto err_free_gpio; |
| } |
| |
| rc = gpio_direction_output(pdata->gpio_a1026_reset, 1); |
| if (rc < 0) { |
| pr_err("%s: request reset gpio direction failed\n", __func__); |
| goto err_free_gpio_all; |
| } |
| |
| if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) { |
| pr_err("%s: i2c check functionality error\n", __func__); |
| rc = -ENODEV; |
| goto err_free_gpio_all; |
| } |
| |
| if (control_a1026_clk) |
| gpio_set_value(pdata->gpio_a1026_clk, 1); |
| gpio_set_value(pdata->gpio_a1026_micsel, 0); |
| gpio_set_value(pdata->gpio_a1026_wakeup, 1); |
| gpio_set_value(pdata->gpio_a1026_reset, 1); |
| |
| rc = misc_register(&a1026_device); |
| if (rc) { |
| pr_err("%s: a1026_device register failed\n", __func__); |
| goto err_free_gpio_all; |
| } |
| |
| return 0; |
| |
| err_free_gpio_all: |
| gpio_free(pdata->gpio_a1026_reset); |
| err_free_gpio: |
| gpio_free(pdata->gpio_a1026_wakeup); |
| err_free_gpio_micsel: |
| gpio_free(pdata->gpio_a1026_micsel); |
| err_free_gpio_clk: |
| if (control_a1026_clk) |
| gpio_free(pdata->gpio_a1026_clk); |
| err_alloc_data_failed: |
| return rc; |
| } |
| |
| static int a1026_remove(struct i2c_client *client) |
| { |
| struct a1026_platform_data *p1026data = i2c_get_clientdata(client); |
| kfree(p1026data); |
| |
| return 0; |
| } |
| |
| static int a1026_suspend(struct i2c_client *client, pm_message_t mesg) |
| { |
| return 0; |
| } |
| |
| static int a1026_resume(struct i2c_client *client) |
| { |
| return 0; |
| } |
| |
| static const struct i2c_device_id a1026_id[] = { |
| { "audience_a1026", 0 }, |
| { } |
| }; |
| |
| static struct i2c_driver a1026_driver = { |
| .probe = a1026_probe, |
| .remove = a1026_remove, |
| .suspend = a1026_suspend, |
| .resume = a1026_resume, |
| .id_table = a1026_id, |
| .driver = { |
| .name = "audience_a1026", |
| }, |
| }; |
| |
| static int __init a1026_init(void) |
| { |
| pr_info("%s\n", __func__); |
| mutex_init(&a1026_lock); |
| |
| return i2c_add_driver(&a1026_driver); |
| } |
| |
| static void __exit a1026_exit(void) |
| { |
| i2c_del_driver(&a1026_driver); |
| } |
| |
| module_init(a1026_init); |
| module_exit(a1026_exit); |
| |
| MODULE_DESCRIPTION("A1026 voice processor driver"); |
| MODULE_LICENSE("GPL"); |