static void max14688_det_work (struct work_struct *work)
{
struct max14688 *me = container_of(work, struct max14688, det_work.work);
int micZ, leftZ;
if(earjack_detect == true) {
log_dbg("duplication intterupt already connect earjack\n");
return;
} else {
earjack_detect = true;
}
__lock(me);
if (unlikely(!me->detect_jack(me->dev))) {
log_warn("no jack in detection work\n");
earjack_detect = false;
goto out;
}
max14688_update_status(me);
/* Read MIC and L-line impedences */
micZ = me->read_mic_impedence(me->dev);
leftZ = me->read_left_impedence(me->dev);
log_dbg("%s[micZ = %d, leftZ = %d\n", __func__, micZ, leftZ);
/* Look up jack matching impedence ranges */
max14688_lookup_jack(me, micZ, leftZ);
if (unlikely(!__present_valid_jack(me))) {
earjack_detect = false;
goto no_match_found;
}
max14688_write_mode0(me, __current_jack_mode0(me));
max14688_write_mode1(me, __current_jack_mode1(me));
if (__current_jack_has_button(me)) {
max14688_enable_irq(me, IRQ_SWD);
} else {
max14688_disable_irq(me, IRQ_SWD);
}
log_dbg("jack %s inserted\n", __current_jack_name(me));
me->report_jack(me->dev, __current_jack(me), JACK_IN_VALUE);
goto out;
no_match_found:
/* Handle exception */
log_err("unknown jack - mic %d, left %d\n", micZ, leftZ);
out:
__unlock(me);
return;
}
static int max14688_probe (struct i2c_client *client, const struct i2c_device_id *id)
{
struct max14688_platform_data *pdata = client->dev.platform_data;
struct max14688 *me;
u8 chip_id, chip_rev;
int i, rc;
u8 pincontrol2 = 0;
#if defined (CONFIG_MACH_MSM8994_Z2_KR) || defined (CONFIG_MACH_MSM8994_Z2_SPR_US) || defined (CONFIG_MACH_MSM8994_Z2_USC_US) || defined (CONFIG_MACH_MSM8994_Z2_GLOBAL_COM) || defined (CONFIG_MACH_MSM8994_Z2_GLOBAL_ESA) || defined (CONFIG_MACH_MSM8994_Z2_ACG_US)
if(strncmp(rev_str[lge_get_board_revno()],"rev_a",5)!=0) // z2 not use max14688 after rev_b
return 0;
#elif defined (CONFIG_ENABLE_MBHC)
return 0; // if both MBHC and MAXAM are enable or model feature is not set, use MBHC as default.
#endif
log_dbg(MAX14688_NAME" attached\n");
log_dbg("wake_lock_init\n");
wake_lock_init(&ear_key_wake_lock, WAKE_LOCK_SUSPEND, "ear_key");
me = kzalloc(sizeof(struct max14688), GFP_KERNEL);
if (me == NULL) {
log_err("Failed to allloate headset per device info\n");
return -ENOMEM;
}
if (client->dev.of_node) {
pdata = devm_kzalloc(&client->dev, sizeof(struct max14688_platform_data), GFP_KERNEL);
if (unlikely(!pdata)) {
log_err("out of memory (%luB requested)\n", sizeof(struct max14688_platform_data));
return -ENOMEM;
}
client->dev.platform_data = pdata;
max14688_parse_dt(&client->dev, pdata);
} else {
pdata = devm_kzalloc(&client->dev, sizeof(struct max14688_platform_data), GFP_KERNEL);
if (unlikely(!pdata)) {
log_err("out of memory (%luB requested)\n", sizeof(struct max14688_platform_data));
return -ENOMEM;
} else {
pdata = client->dev.platform_data;
}
}
i2c_set_clientdata(client, me);
spin_lock_init(&me->irq_lock);
mutex_init(&me->lock);
me->dev = &client->dev;
me->kobj = &client->dev.kobj;
me->irq = -1;
me->gpio_int = pdata->gpio_int;
me->gpio_detect = pdata->gpio_detect;
INIT_DELAYED_WORK(&me->irq_work, max14688_irq_work);
INIT_DELAYED_WORK(&me->det_work, max14688_det_work);
#ifdef I2C_SUSPEND_WORKAROUND
INIT_DELAYED_WORK(&me->check_suspended_work, max14688_check_suspended_worker);
#endif
rc = gpio_request(me->gpio_detect, MAX14688_NAME"-detect");
if (unlikely(rc)) {
return rc;
}
rc = gpio_direction_input(me->gpio_detect);
if (rc < 0) {
log_err("Failed to configure gpio%d (me->gpio_detect) gpio_direction_input\n", me->gpio_detect);
gpio_free(me->gpio_detect);
return rc;
}
rc = gpio_request(me->gpio_int, MAX14688_NAME"-irq");
if (unlikely(rc)) {
return rc;
}
rc = gpio_direction_input(me->gpio_int);
if (rc < 0) {
log_err("Failed to configure gpio%d (me->gpio_int) gpio_direction_input\n", me->gpio_int);
gpio_free(me->gpio_int);
return rc;
}
me->irq = gpio_to_irq(me->gpio_int);
/* Save jack lookup table given via platform data */
me->jack_matches = pdata->jack_matches;
me->num_of_jack_matches = pdata->num_of_jack_matches;
/* Save button lookup table given via platform data */
me->button_matches = pdata->button_matches;
me->num_of_button_matches = pdata->num_of_button_matches;
me->matched_jack = -1;
me->matched_button = -1;
/* Platform-specific Calls */
me->detect_jack = pdata->detect_jack;
me->read_mic_impedence = pdata->read_mic_impedence;
me->read_left_impedence = pdata->read_left_impedence;
me->report_jack = pdata->report_jack;
me->report_button = pdata->report_button;
/* Disable & Clear all interrupts */
max14688_write(me, MASK, 0x00);
max14688_read(me, INTERRUPT, &me->irq_saved);
/* INT AUTO disable(INT follows the state diagram and flow chart) */
max14688_read(me, PINCONTROL2, &pincontrol2);
max14688_write(me, PINCONTROL2, ~PINCONTROL2_INTAUTO & pincontrol2);
max14688_read(me, PINCONTROL2, &pincontrol2);
log_dbg("%s[pincontrol2 = %d]\n", __func__, pincontrol2);
/* Default MODE setting */
max14688_write_mode0(me, MAX14688_MODE_LOW);
max14688_write_mode1(me, MAX14688_MODE_LOW);
me->irq_saved = 0;
me->irq_unmask = 0;
log_dbg("%s[me->irq_saved = %d]\n", __func__, me->irq_saved);
/* Register input_dev */
me->input_dev = input_allocate_device();
if (unlikely(!me->input_dev)) {
log_err("failed to allocate memory for new input device\n");
rc = -ENOMEM;
goto abort;
}
/* initialize switch device */
me->sdev.name = pdata->switch_name;
rc = switch_dev_register(&me->sdev);
if (rc < 0) {
log_err("Failed to register switch device\n");
switch_dev_unregister(&me->sdev);
goto abort;
}
me->input_dev->name = DRIVER_NAME;
me->input_dev->phys = DRIVER_NAME"/input0";
me->input_dev->dev.parent = me->dev;
for (i = 0; i < me->num_of_jack_matches; i++) {
if (likely(me->jack_matches[i].evt_type < EV_MAX)) {
input_set_capability(me->input_dev,
me->jack_matches[i].evt_type, me->jack_matches[i].evt_code1);
if (likely(me->jack_matches[i].evt_code2))
input_set_capability(me->input_dev,
me->jack_matches[i].evt_type, me->jack_matches[i].evt_code2);
}
}
for (i = 0; i < me->num_of_button_matches; i++) {
if (likely(me->button_matches[i].evt_type < EV_MAX)) {
input_set_capability(me->input_dev,
me->button_matches[i].evt_type, me->button_matches[i].evt_code);
}
}
rc = input_register_device(me->input_dev);
if (unlikely(rc)) {
log_err("failed to register input device [%d]\n", rc);
input_free_device(me->input_dev);
me->input_dev = NULL;
goto abort;
}
/* Create max14688 sysfs attributes */
me->attr_grp = &max14688_attr_group;
rc = sysfs_create_group(me->kobj, me->attr_grp);
if (unlikely(rc)) {
log_err("failed to create attribute group [%d]\n", rc);
me->attr_grp = NULL;
goto abort;
}
/* Get MAX14688 IRQ */
if (unlikely(me->irq < 0)) {
log_warn("interrupt disabled\n");
} else {
/* Request system IRQ for MAX14688 */
rc = request_threaded_irq(me->irq, NULL, max14688_isr,
IRQF_ONESHOT | IRQF_TRIGGER_FALLING, DRIVER_NAME, me);
if (unlikely(rc < 0)) {
log_err("failed to request IRQ(%u) [%d]\n", me->irq, rc);
me->irq = -1;
goto abort;
}
disable_irq((unsigned int)me->irq);
}
max14688_enable_irq(me, IRQ_DET);
/* Complete initialization */
log_info(DRIVER_DESC" "DRIVER_VERSION" Installed\n");
chip_id = 0;
chip_rev = 0;
max14688_read_device_id(me, &chip_id, &chip_rev);
log_info("chip id %02X rev %02X\n", chip_id, chip_rev);
if (me->detect_jack(me->dev)) {
max14688_irq_jack_inserted(me);
}
return 0;
abort:
i2c_set_clientdata(client, NULL);
max14688_destroy(me);
return rc;
}
