static irqreturn_t earjack_debugger_irq_handler(int irq, void *_dev)
{
struct earjack_debugger_device *adev = _dev;
int detect;
printk(KERN_INFO "Calling %s\n", __func__);
msleep(400);
detect = earjack_debugger_detected(adev);
if (detect) {
pr_debug("%s() : in!!\n", __func__);
printk(KERN_INFO "%s() : in!!\n", __func__);
adev->set_uart_console(
lge_uart_console_should_enable_on_earjack_debugger());
} else {
/* restore uart console status to default mode */
pr_debug("%s() : out!!\n", __func__);
printk(KERN_INFO "%s() : out!!\n", __func__);
adev->set_uart_console(
lge_uart_console_should_enable_on_default());
}
return IRQ_HANDLED;
}
static void max14688_irq_jack_inserted (struct max14688 *me)
{
unsigned long det_work_delay = msecs_to_jiffies(500);
#ifdef CONFIG_LGE_EARJACK_DEBUGGER
msm_serial_set_uart_console(lge_uart_console_should_enable_on_default());
#endif
/* Check INT bit and STATUS_INT bit for avoiding JIG mode */
if (unlikely(max14688_get_status(me, STATUS_INT) && max14688_get_status(me, STATUS_MICIN))) {
log_info("JIG power detected\n");
max14688_disable_irq(me, IRQ_SWD);
#ifdef CONFIG_LGE_EARJACK_DEBUGGER
msm_serial_set_uart_console(lge_uart_console_should_enable_on_earjack_debugger());
#endif
me->matched_jack = -1;
me->matched_button = -1;
goto out;
}
if (unlikely(__present_valid_jack(me))) {
log_warn("new jack detected during insertion of jack %s\n",
__current_jack_name(me));
#ifdef MAX14688_OVERWRITE_JACK_INSERTION
max14688_irq_jack_removed(me);
#else
goto out;
#endif
}
if (unlikely(delayed_work_pending(&me->det_work))) {
log_warn("detection in progress\n");
goto out;
}
log_dbg("%s\n", __func__);
max14688_write_mode0(me, MAX14688_MODE_HIGH);
max14688_write_mode1(me, MAX14688_MODE_LOW);
schedule_delayed_work(&me->det_work, det_work_delay);
out:
return;
}
static int earjack_debugger_probe(struct platform_device *pdev)
{
int ret = 0;
struct earjack_debugger_device *adev;
struct earjack_debugger_platform_data *pdata;
lge_uart_console_set_config(UART_CONSOLE_ENABLE_ON_EARJACK_DEBUGGER);
if (pdev->dev.of_node) {
pdata = devm_kzalloc(&pdev->dev,
sizeof(struct earjack_debugger_platform_data),
GFP_KERNEL);
if (pdata == NULL) {
pr_err("%s: no pdata\n", __func__);
return -ENOMEM;
}
pdev->dev.platform_data = pdata;
earjack_debugger_parse_dt(&pdev->dev, pdata);
} else {
pdata = pdev->dev.platform_data;
}
if (!pdata) {
pr_err("%s: no pdata\n", __func__);
return -ENOMEM;
}
adev = kzalloc(sizeof(struct earjack_debugger_device), GFP_KERNEL);
if (!adev) {
pr_err("%s: no memory\n", __func__);
return -ENOMEM;
}
adev->gpio = pdata->gpio_trigger;
adev->irq = gpio_to_irq(pdata->gpio_trigger);
adev->set_uart_console = msm_serial_set_uart_console;
platform_set_drvdata(pdev, adev);
ret = gpio_request_one(adev->gpio, GPIOF_IN,
"gpio_earjack_debugger");
if (ret < 0) {
pr_err("%s: failed to request gpio %d\n", __func__,
adev->gpio);
goto err_gpio_request;
}
ret = request_threaded_irq(adev->irq, NULL,
earjack_debugger_irq_handler,
IRQF_TRIGGER_RISING |
IRQF_TRIGGER_FALLING |
IRQF_ONESHOT,
"earjack_debugger_trigger", adev);
if (ret < 0) {
pr_err("%s: failed to request irq\n", __func__);
goto err_request_irq;
}
if (earjack_debugger_detected(adev)) {
pr_debug("[UART CONSOLE][%s] %s uart console\n",
__func__,
lge_uart_console_should_enable_on_earjack_debugger() ?
"enable" : "disable");
adev->set_uart_console(
lge_uart_console_should_enable_on_earjack_debugger());
}
pr_info("earjack debugger probed\n");
return ret;
err_request_irq:
gpio_free(adev->gpio);
err_gpio_request:
kfree(adev);
return ret;
}
