static int i2c_touchkey_probe(struct i2c_client *client,
const struct i2c_device_id *id)
{
// struct touchkey_platform_data *pdata = client->dev.platform_data;
struct touchkey_i2c *tkey_i2c;
struct input_dev *input_dev;
int err = 0;
int i;
int ret;
printk("[TouchKey] i2c_touchkey_probe\n");
/* if (pdata == NULL) {
printk(KERN_ERR "%s: no pdata\n", __func__);
return -ENODEV;
}*/
/*Check I2C functionality */
ret = i2c_check_functionality(client->adapter, I2C_FUNC_I2C);
if (ret == 0) {
printk(KERN_ERR "[Touchkey] No I2C functionality found\n");
ret = -ENODEV;
return ret;
}
/*Obtain kernel memory space for touchkey i2c */
tkey_i2c = kzalloc(sizeof(struct touchkey_i2c), GFP_KERNEL);
if (NULL == tkey_i2c) {
printk(KERN_ERR "[Touchkey] failed to allocate tkey_i2c.\n");
return -ENOMEM;
}
input_dev = input_allocate_device();
if (!input_dev) {
printk(KERN_ERR"[Touchkey] failed to allocate input device\n");
kfree(tkey_i2c);
return -ENOMEM;
}
input_dev->name = "sec_touchkey";
input_dev->phys = "sec_touchkey/input0";
input_dev->id.bustype = BUS_HOST;
input_dev->dev.parent = &client->dev;
/*tkey_i2c*/
// tkey_i2c->pdata = pdata;
tkey_i2c->input_dev = input_dev;
tkey_i2c->client = client;
i2c_set_clientdata(client, tkey_i2c);
tkey_i2c->irq = client->irq;
tkey_i2c->name = "sec_touchkey";
set_bit(EV_SYN, input_dev->evbit);
set_bit(EV_LED, input_dev->evbit);
set_bit(LED_MISC, input_dev->ledbit);
set_bit(EV_KEY, input_dev->evbit);
for (i = 1; i < touchkey_count; i++)
set_bit(touchkey_keycode[i], input_dev->keybit);
input_set_drvdata(input_dev, tkey_i2c);
printk("[TouchKey]: tkey_i2c->irq : %d\n", tkey_i2c->irq);
ret = input_register_device(input_dev);
if (ret) {
printk(KERN_ERR"[Touchkey] failed to register input device\n");
input_free_device(input_dev);
kfree(tkey_i2c);
return err;
}
INIT_WORK(&tkey_i2c->update_work, touchkey_update_func);
#if defined(CONFIG_S2VE_TOUCHKEY_REV05)
Touchkey_PowerOnOff(1);
#endif
touchkey_enable = 1;
touchkey_led_on(tkey_i2c, 1);
msleep(50);
/*sysfs*/
tkey_i2c->dev = device_create(sec_class, NULL, 0, NULL, "sec_touchkey");
if (IS_ERR(tkey_i2c->dev)) {
printk("Failed to create device(tkey_i2c->dev)!\n");
input_unregister_device(input_dev);
} else {
dev_set_drvdata(tkey_i2c->dev, tkey_i2c);
ret = sysfs_create_group(&tkey_i2c->dev->kobj,
&touchkey_attr_group);
if (ret) {
printk( "[TouchKey]: failed to create sysfs group\n");
}
}
ret = request_threaded_irq(tkey_i2c->irq, NULL /*touchkey_irq_handler*/, touchkey_interrupt,
IRQF_DISABLED | IRQF_TRIGGER_FALLING /* | IRQF_ONESHOT */, tkey_i2c->name, tkey_i2c);
if (ret < 0) {
printk("[Touchkey]: failed to request irq(%d) - %d\n", tkey_i2c->irq, ret);
input_unregister_device(input_dev);
return -EBUSY;
}
#ifdef CONFIG_HAS_EARLYSUSPEND
tkey_i2c->early_suspend.suspend =
(void *)sec_touchkey_early_suspend;
tkey_i2c->early_suspend.resume =
(void *)sec_touchkey_late_resume;
register_early_suspend(&tkey_i2c->early_suspend);
#endif
#if 0 //defined(TK_HAS_FIRMWARE_UPDATE)
ret = touchkey_firmware_update(tkey_i2c);
if (ret < 0) {
printk(KERN_ERR "[Touchkey]: failed firmware updating process (%d)\n", ret);
input_unregister_device(input_dev);
return -EBUSY;
}
#endif
#if defined(TK_HAS_AUTOCAL)
touchkey_autocalibration(tkey_i2c);
#endif
printk("[Touchkey]: %s Probe done! \n", __func__);
set_touchkey_debug('K');
return 0;
}
static int i2c_touchkey_probe(struct i2c_client *client,
const struct i2c_device_id *id)
{
struct touchkey_platform_data *pdata = client->dev.platform_data;
struct touchkey_i2c *tkey_i2c;
struct input_dev *input_dev;
int err = 0;
unsigned char data;
int i;
int ret;
pr_debug("[TouchKey] i2c_touchkey_probe\n");
if (pdata == NULL) {
printk(KERN_ERR "%s: no pdata\n", __func__);
return -ENODEV;
}
/*Check I2C functionality */
ret = i2c_check_functionality(client->adapter, I2C_FUNC_I2C);
if (ret == 0) {
pr_err("[Touchkey] No I2C functionality found\n");
ret = -ENODEV;
return ret;
}
/*Obtain kernel memory space for touchkey i2c */
tkey_i2c = kzalloc(sizeof(struct touchkey_i2c), GFP_KERNEL);
if (NULL == tkey_i2c) {
pr_err("[Touchkey] failed to allocate tkey_i2c.\n");
return -ENOMEM;
}
tkey_i2c_local = tkey_i2c;
input_dev = input_allocate_device();
if (!input_dev) {
pr_err("[Touchkey] failed to allocate input device\n");
kfree(tkey_i2c);
return -ENOMEM;
}
input_dev->name = "sec_touchkey";
input_dev->phys = "sec_touchkey/input0";
input_dev->id.bustype = BUS_HOST;
input_dev->dev.parent = &client->dev;
/*tkey_i2c*/
tkey_i2c->pdata = pdata;
tkey_i2c->input_dev = input_dev;
tkey_i2c->client = client;
tkey_i2c->irq = client->irq;
tkey_i2c->name = "sec_touchkey";
set_bit(EV_SYN, input_dev->evbit);
set_bit(EV_LED, input_dev->evbit);
set_bit(LED_MISC, input_dev->ledbit);
set_bit(EV_KEY, input_dev->evbit);
for (i = 1; i < touchkey_count; i++)
set_bit(touchkey_keycode[i], input_dev->keybit);
input_set_drvdata(input_dev, tkey_i2c);
ret = input_register_device(input_dev);
if (ret) {
pr_err("[Touchkey] failed to register input device\n");
input_free_device(input_dev);
kfree(tkey_i2c);
return err;
}
INIT_WORK(&tkey_i2c->update_work, touchkey_update_func);
tkey_i2c->pdata->power_on(1);
msleep(50);
touchkey_enable = 1;
data = 1;
/*sysfs*/
tkey_i2c->dev = device_create(sec_class, NULL, 0, NULL, "sec_touchkey");
if (IS_ERR(tkey_i2c->dev)) {
pr_err("[TouchKey] Failed to create device(tkey_i2c->dev)!\n");
input_unregister_device(input_dev);
} else {
dev_set_drvdata(tkey_i2c->dev, tkey_i2c);
ret = sysfs_create_group(&tkey_i2c->dev->kobj,
&touchkey_attr_group);
if (ret) {
pr_err("[TouchKey]: failed to create sysfs group\n");
}
}
#if defined(CONFIG_MACH_M0) || defined(CONFIG_MACH_C1)
gpio_request(GPIO_OLED_DET, "OLED_DET");
ret = gpio_get_value(GPIO_OLED_DET);
pr_debug("[TouchKey] OLED_DET = %d\n", ret);
if (ret == 0) {
pr_debug("[TouchKey] device wasn't connected to board\n");
input_unregister_device(input_dev);
touchkey_probe = false;
return -EBUSY;
}
#else
ret = touchkey_i2c_check(tkey_i2c);
if (ret < 0) {
pr_debug("[TouchKey] probe failed\n");
input_unregister_device(input_dev);
touchkey_probe = false;
return -EBUSY;
}
#endif
ret =
request_threaded_irq(tkey_i2c->irq, NULL, touchkey_interrupt,
IRQF_DISABLED | IRQF_TRIGGER_FALLING |
IRQF_ONESHOT, tkey_i2c->name, tkey_i2c);
if (ret < 0) {
pr_err("[Touchkey]: failed to request irq(%d) - %d\n",
tkey_i2c->irq, ret);
input_unregister_device(input_dev);
touchkey_probe = false;
return -EBUSY;
}
tkey_i2c->pdata->led_power_on(1);
#if defined(TK_HAS_FIRMWARE_UPDATE)
ret = touchkey_firmware_update(tkey_i2c);
if (ret < 0) {
pr_err("[Touchkey]: failed firmware updating process (%d)\n",
ret);
input_unregister_device(input_dev);
touchkey_probe = false;
return -EBUSY;
}
#endif
#ifdef CONFIG_HAS_EARLYSUSPEND
tkey_i2c->early_suspend.suspend =
(void *)sec_touchkey_early_suspend;
tkey_i2c->early_suspend.resume =
(void *)sec_touchkey_late_resume;
register_early_suspend(&tkey_i2c->early_suspend);
#endif
#if defined(TK_HAS_AUTOCAL)
touchkey_autocalibration(tkey_i2c);
#endif
set_touchkey_debug('K');
// init workqueue
tkey_i2c->wq = create_singlethread_workqueue("tkey_i2c_wq");
if (!tkey_i2c->wq) {
ret = -ENOMEM;
pr_err("[Touchkey] %s: could not create workqueue\n", __func__);
}
/* this is the thread function we run on the work queue */
INIT_WORK(&tkey_i2c->work, touch_led_timedout_work);
return 0;
}