/* Copyright (C) 2010 Samsung Electronics. All rights reserved. * * 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. * * 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. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA * 02110-1301 USA */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include /* Note about power vs enable/disable: * The chip has two functions, proximity and ambient light sensing. * There is no separate power enablement to the two functions (unlike * the Capella CM3602/3623). * This module implements two drivers: /dev/proximity and /dev/light. * When either driver is enabled (via sysfs attributes), we give power * to the chip. When both are disabled, we remove power from the chip. * In suspend, we remove power if light is disabled but not if proximity is * enabled (proximity is allowed to wakeup from suspend). * * There are no ioctls for either driver interfaces. Output is via * input device framework and control via sysfs attributes. */ #define gp2a_dbgmsg(str, args...) pr_debug("%s: " str, __func__, ##args) #define ADC_BUFFER_NUM 6 /* ADDSEL is LOW */ #define REGS_PROX 0x0 /* Read Only */ #define REGS_GAIN 0x1 /* Write Only */ #define REGS_HYS 0x2 /* Write Only */ #define REGS_CYCLE 0x3 /* Write Only */ #define REGS_OPMOD 0x4 /* Write Only */ /* sensor type */ #define LIGHT 0 #define PROXIMITY 1 #define ALL 2 #if defined(CONFIG_MACH_Q1_BD) /* light sensor adc channel */ #define ALS_IOUT_ADC 2 #endif static u8 reg_defaults[5] = { 0x00, /* PROX: read only register */ 0x08, /* GAIN: large LED drive level */ 0x40, /* HYS: receiver sensitivity - B1 mode */ 0x04, /* CYCLE: */ 0x01, /* OPMOD: normal operating mode */ }; enum { LIGHT_ENABLED = BIT(0), PROXIMITY_ENABLED = BIT(1), }; /* driver data */ struct gp2a_data { struct input_dev *proximity_input_dev; struct input_dev *light_input_dev; struct gp2a_platform_data *pdata; struct i2c_client *i2c_client; struct class *lightsensor_class; struct device *switch_cmd_dev; int irq; struct work_struct work_light; struct hrtimer timer; ktime_t light_poll_delay; int adc_value_buf[ADC_BUFFER_NUM]; int adc_index_count; bool adc_buf_initialized; bool on; u8 power_state; struct mutex power_lock; struct wake_lock prx_wake_lock; struct workqueue_struct *wq; struct mutex adc_lock; char val_state; struct s3c_adc_client *padc; struct platform_device *pdev_gp2a_adc; }; int gp2a_i2c_write(struct gp2a_data *gp2a, u8 reg, u8 *val) { int err = 0; struct i2c_msg msg[1]; unsigned char data[2]; int retry = 10; struct i2c_client *client = gp2a->i2c_client; if ((client == NULL) || (!client->adapter)) return -ENODEV; data[0] = reg; data[1] = *val; msg->addr = client->addr; msg->flags = 0; /* write */ msg->len = 2; msg->buf = data; while (retry--) { err = i2c_transfer(client->adapter, msg, 1); if (err == 1) return 0; } pr_err("%s failed\n", __func__); return err; } static void gp2a_light_enable(struct gp2a_data *gp2a) { gp2a_dbgmsg("starting poll timer, delay %lldns\n", ktime_to_ns(gp2a->light_poll_delay)); hrtimer_start(&gp2a->timer, gp2a->light_poll_delay, HRTIMER_MODE_REL); } static void gp2a_light_disable(struct gp2a_data *gp2a) { gp2a_dbgmsg("cancelling poll timer\n"); hrtimer_cancel(&gp2a->timer); cancel_work_sync(&gp2a->work_light); /* mark the adc buff as not initialized * so that it will be filled again on next light sensor start */ gp2a->adc_buf_initialized = false; } static ssize_t poll_delay_show(struct device *dev, struct device_attribute *attr, char *buf) { struct gp2a_data *gp2a = dev_get_drvdata(dev); return sprintf(buf, "%lld\n", ktime_to_ns(gp2a->light_poll_delay)); } static ssize_t poll_delay_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t size) { struct gp2a_data *gp2a = dev_get_drvdata(dev); int64_t new_delay; int err; err = strict_strtoll(buf, 10, &new_delay); if (err < 0) return err; gp2a_dbgmsg("new delay = %lldns, old delay = %lldns\n", new_delay, ktime_to_ns(gp2a->light_poll_delay)); mutex_lock(&gp2a->power_lock); if (new_delay != ktime_to_ns(gp2a->light_poll_delay)) { gp2a->light_poll_delay = ns_to_ktime(new_delay); if (gp2a->power_state & LIGHT_ENABLED) { gp2a_light_disable(gp2a); gp2a_light_enable(gp2a); } } mutex_unlock(&gp2a->power_lock); return size; } static ssize_t light_enable_show(struct device *dev, struct device_attribute *attr, char *buf) { struct gp2a_data *gp2a = dev_get_drvdata(dev); return sprintf(buf, "%d\n", (gp2a->power_state & LIGHT_ENABLED) ? 1 : 0); } static ssize_t proximity_enable_show(struct device *dev, struct device_attribute *attr, char *buf) { struct gp2a_data *gp2a = dev_get_drvdata(dev); return sprintf(buf, "%d\n", (gp2a->power_state & PROXIMITY_ENABLED) ? 1 : 0); } static ssize_t light_enable_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t size) { struct gp2a_data *gp2a = dev_get_drvdata(dev); bool new_value; if (sysfs_streq(buf, "1")) new_value = true; else if (sysfs_streq(buf, "0")) new_value = false; else { pr_err("%s: invalid value %d\n", __func__, *buf); return -EINVAL; } mutex_lock(&gp2a->power_lock); gp2a_dbgmsg("new_value = %d, old state = %d\n", new_value, (gp2a->power_state & LIGHT_ENABLED) ? 1 : 0); if (new_value && !(gp2a->power_state & LIGHT_ENABLED)) { #if defined(CONFIG_MACH_Q1_BD) if (!gp2a->power_state) gp2a->pdata->power(true); #endif gp2a->power_state |= LIGHT_ENABLED; gp2a_light_enable(gp2a); } else if (!new_value && (gp2a->power_state & LIGHT_ENABLED)) { gp2a_light_disable(gp2a); gp2a->power_state &= ~LIGHT_ENABLED; #if defined(CONFIG_MACH_Q1_BD) if (!gp2a->power_state) gp2a->pdata->power(false); #endif } mutex_unlock(&gp2a->power_lock); return size; } static ssize_t proximity_enable_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t size) { struct gp2a_data *gp2a = dev_get_drvdata(dev); bool new_value; if (sysfs_streq(buf, "1")) new_value = true; else if (sysfs_streq(buf, "0")) new_value = false; else { pr_err("%s: invalid value %d\n", __func__, *buf); return -EINVAL; } mutex_lock(&gp2a->power_lock); gp2a_dbgmsg("new_value = %d, old state = %d\n", new_value, (gp2a->power_state & PROXIMITY_ENABLED) ? 1 : 0); if (new_value && !(gp2a->power_state & PROXIMITY_ENABLED)) { #if defined(CONFIG_MACH_Q1_BD) if (!gp2a->power_state) gp2a->pdata->power(true); #endif gp2a->power_state |= PROXIMITY_ENABLED; gp2a_i2c_write(gp2a, REGS_GAIN, ®_defaults[1]); gp2a_i2c_write(gp2a, REGS_HYS, ®_defaults[2]); gp2a_i2c_write(gp2a, REGS_CYCLE, ®_defaults[3]); gp2a_i2c_write(gp2a, REGS_OPMOD, ®_defaults[4]); enable_irq(gp2a->irq); enable_irq_wake(gp2a->irq); } else if (!new_value && (gp2a->power_state & PROXIMITY_ENABLED)) { disable_irq_wake(gp2a->irq); disable_irq(gp2a->irq); gp2a_i2c_write(gp2a, REGS_OPMOD, ®_defaults[0]); gp2a->power_state &= ~PROXIMITY_ENABLED; #if defined(CONFIG_MACH_Q1_BD) if (!gp2a->power_state) gp2a->pdata->power(false); #endif } mutex_unlock(&gp2a->power_lock); return size; } static DEVICE_ATTR(poll_delay, S_IRUGO | S_IWUSR | S_IWGRP, poll_delay_show, poll_delay_store); static struct device_attribute dev_attr_light_enable = __ATTR(enable, S_IRUGO | S_IWUSR | S_IWGRP, light_enable_show, light_enable_store); static struct device_attribute dev_attr_proximity_enable = __ATTR(enable, S_IRUGO | S_IWUSR | S_IWGRP, proximity_enable_show, proximity_enable_store); static struct attribute *light_sysfs_attrs[] = { &dev_attr_light_enable.attr, &dev_attr_poll_delay.attr, NULL }; static struct attribute_group light_attribute_group = { .attrs = light_sysfs_attrs, }; static struct attribute *proximity_sysfs_attrs[] = { &dev_attr_proximity_enable.attr, NULL }; static struct attribute_group proximity_attribute_group = { .attrs = proximity_sysfs_attrs, }; static int lightsensor_get_adcvalue(struct gp2a_data *gp2a) { int i = 0; int j = 0; unsigned int adc_total = 0; int adc_avr_value; unsigned int adc_index = 0; unsigned int adc_max = 0; unsigned int adc_min = 0; int value = 0; /* get ADC */ /* value = gp2a->pdata->light_adc_value(); */ value = s3c_adc_read(gp2a->padc, ALS_IOUT_ADC); if (value < 0) pr_err("%s: s3c_adc_read() failed(%d)\n", __func__, value); adc_index = (gp2a->adc_index_count++) % ADC_BUFFER_NUM; /*ADC buffer initialize (light sensor off ---> light sensor on) */ if (!gp2a->adc_buf_initialized) { gp2a->adc_buf_initialized = true; for (j = 0; j < ADC_BUFFER_NUM; j++) gp2a->adc_value_buf[j] = value; } else gp2a->adc_value_buf[adc_index] = value; adc_max = gp2a->adc_value_buf[0]; adc_min = gp2a->adc_value_buf[0]; for (i = 0; i < ADC_BUFFER_NUM; i++) { adc_total += gp2a->adc_value_buf[i]; if (adc_max < gp2a->adc_value_buf[i]) adc_max = gp2a->adc_value_buf[i]; if (adc_min > gp2a->adc_value_buf[i]) adc_min = gp2a->adc_value_buf[i]; } adc_avr_value = (adc_total-(adc_max+adc_min))/(ADC_BUFFER_NUM-2); if (gp2a->adc_index_count == ADC_BUFFER_NUM-1) gp2a->adc_index_count = 0; return adc_avr_value; } static void gp2a_work_func_light(struct work_struct *work) { struct gp2a_data *gp2a = container_of(work, struct gp2a_data, work_light); int adc = 0; mutex_lock(&gp2a->adc_lock); adc = lightsensor_get_adcvalue(gp2a); mutex_unlock(&gp2a->adc_lock); input_report_abs(gp2a->light_input_dev, ABS_MISC, adc); input_sync(gp2a->light_input_dev); } /* This function is for light sensor. It operates every a few seconds. * It asks for work to be done on a thread because i2c needs a thread * context (slow and blocking) and then reschedules the timer to run again. */ static enum hrtimer_restart gp2a_timer_func(struct hrtimer *timer) { struct gp2a_data *gp2a = container_of(timer, struct gp2a_data, timer); queue_work(gp2a->wq, &gp2a->work_light); hrtimer_forward_now(&gp2a->timer, gp2a->light_poll_delay); return HRTIMER_RESTART; } /* interrupt happened due to transition/change of near/far proximity state */ irqreturn_t gp2a_irq_handler(int irq, void *data) { struct gp2a_data *ip = data; u8 setting; int val = gpio_get_value(ip->pdata->p_out); if (val < 0) { pr_err("%s: gpio_get_value error %d\n", __func__, val); return IRQ_HANDLED; } if (val != ip->val_state) { if (val) setting = 0x40; else setting = 0x20; gp2a_i2c_write(ip, REGS_HYS, &setting); } ip->val_state = val; pr_err("gp2a: proximity val = %d\n", val); /* 0 is close, 1 is far */ input_report_abs(ip->proximity_input_dev, ABS_DISTANCE, val); input_sync(ip->proximity_input_dev); wake_lock_timeout(&ip->prx_wake_lock, 3*HZ); return IRQ_HANDLED; } static int gp2a_setup_irq(struct gp2a_data *gp2a) { int rc = -EIO; struct gp2a_platform_data *pdata = gp2a->pdata; int irq; gp2a_dbgmsg("start\n"); rc = gpio_request(pdata->p_out, "gpio_proximity_out"); if (rc < 0) { pr_err("%s: gpio %d request failed (%d)\n", __func__, pdata->p_out, rc); return rc; } rc = gpio_direction_input(pdata->p_out); if (rc < 0) { pr_err("%s: failed to set gpio %d as input (%d)\n", __func__, pdata->p_out, rc); goto err_gpio_direction_input; } irq = gpio_to_irq(pdata->p_out); rc = request_threaded_irq(irq, NULL, gp2a_irq_handler, IRQF_TRIGGER_RISING | IRQF_TRIGGER_FALLING, "proximity_int", gp2a); if (rc < 0) { pr_err("%s: request_irq(%d) failed for gpio %d (%d)\n", __func__, irq, pdata->p_out, rc); goto err_request_irq; } /* start with interrupts disabled */ disable_irq(irq); gp2a->irq = irq; gp2a_dbgmsg("success\n"); goto done; err_request_irq: err_gpio_direction_input: gpio_free(pdata->p_out); done: return rc; } static ssize_t lightsensor_file_state_show(struct device *dev, struct device_attribute *attr, char *buf) { struct gp2a_data *gp2a = dev_get_drvdata(dev); int adc = 0; mutex_lock(&gp2a->adc_lock); adc = lightsensor_get_adcvalue(gp2a); mutex_unlock(&gp2a->adc_lock); return sprintf(buf, "%d\n", adc); } static DEVICE_ATTR(lightsensor_file_state, 0644, lightsensor_file_state_show, NULL); static const struct file_operations light_fops = { .owner = THIS_MODULE, }; static struct miscdevice light_device = { .minor = MISC_DYNAMIC_MINOR, .name = "light", .fops = &light_fops, }; static int gp2a_i2c_probe(struct i2c_client *client, const struct i2c_device_id *id) { int ret = -ENODEV; struct input_dev *input_dev; struct gp2a_data *gp2a; struct gp2a_platform_data *pdata = client->dev.platform_data; if (!pdata) { pr_err("%s: missing pdata!\n", __func__); return ret; } if (!pdata->power/*|| !pdata->light_adc_value*/) { pr_err("%s: incomplete pdata!\n", __func__); return ret; } if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) { pr_err("%s: i2c functionality check failed!\n", __func__); return ret; } gp2a = kzalloc(sizeof(struct gp2a_data), GFP_KERNEL); if (!gp2a) { pr_err("%s: failed to alloc memory for module data\n", __func__); return -ENOMEM; } gp2a->val_state = 1; gp2a->pdata = pdata; gp2a->i2c_client = client; i2c_set_clientdata(client, gp2a); /* wake lock init */ wake_lock_init(&gp2a->prx_wake_lock, WAKE_LOCK_SUSPEND, "prx_wake_lock"); mutex_init(&gp2a->power_lock); mutex_init(&gp2a->adc_lock); ret = gp2a_setup_irq(gp2a); if (ret) { pr_err("%s: could not setup irq\n", __func__); goto err_setup_irq; } /* allocate proximity input_device */ input_dev = input_allocate_device(); if (!input_dev) { pr_err("%s: could not allocate input device\n", __func__); goto err_input_allocate_device_proximity; } gp2a->proximity_input_dev = input_dev; input_set_drvdata(input_dev, gp2a); input_dev->name = "proximity_sensor"; input_set_capability(input_dev, EV_ABS, ABS_DISTANCE); input_set_abs_params(input_dev, ABS_DISTANCE, 0, 1, 0, 0); gp2a_dbgmsg("registering proximity input device\n"); ret = input_register_device(input_dev); if (ret < 0) { pr_err("%s: could not register input device\n", __func__); input_free_device(input_dev); goto err_input_register_device_proximity; } ret = sysfs_create_group(&input_dev->dev.kobj, &proximity_attribute_group); if (ret) { pr_err("%s: could not create sysfs group\n", __func__); goto err_sysfs_create_group_proximity; } /* hrtimer settings. we poll for light values using a timer. */ hrtimer_init(&gp2a->timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL); gp2a->light_poll_delay = ns_to_ktime(200 * NSEC_PER_MSEC); gp2a->timer.function = gp2a_timer_func; /* the timer just fires off a work queue request. we need a thread * to read the i2c (can be slow and blocking) */ gp2a->wq = create_singlethread_workqueue("gp2a_wq"); if (!gp2a->wq) { ret = -ENOMEM; pr_err("%s: could not create workqueue\n", __func__); goto err_create_workqueue; } /* this is the thread function we run on the work queue */ INIT_WORK(&gp2a->work_light, gp2a_work_func_light); /* allocate lightsensor-level input_device */ input_dev = input_allocate_device(); if (!input_dev) { pr_err("%s: could not allocate input device\n", __func__); ret = -ENOMEM; goto err_input_allocate_device_light; } input_set_drvdata(input_dev, gp2a); input_dev->name = "light_sensor"; input_set_capability(input_dev, EV_ABS, ABS_MISC); input_set_abs_params(input_dev, ABS_MISC, 0, 1, 0, 0); gp2a_dbgmsg("registering lightsensor-level input device\n"); ret = input_register_device(input_dev); if (ret < 0) { pr_err("%s: could not register input device\n", __func__); input_free_device(input_dev); goto err_input_register_device_light; } gp2a->light_input_dev = input_dev; ret = sysfs_create_group(&input_dev->dev.kobj, &light_attribute_group); if (ret) { pr_err("%s: could not create sysfs group\n", __func__); goto err_sysfs_create_group_light; } /* alloc platform device for adc client */ gp2a->pdev_gp2a_adc = platform_device_alloc("gp2a-adc", -1); if (!gp2a->pdev_gp2a_adc) { pr_err("%s: could not allocation pdev_gp2a_adc.\n", __func__); ret = -ENOMEM; goto err_platform_allocate_device_adc; } /* Register adc client */ gp2a->padc = s3c_adc_register(gp2a->pdev_gp2a_adc, NULL, NULL, 0); if (IS_ERR(gp2a->padc)) { dev_err(&gp2a->pdev_gp2a_adc->dev, "cannot register adc\n"); ret = PTR_ERR(gp2a->padc); goto err_platform_register_device_adc; } /* set sysfs for light sensor */ ret = misc_register(&light_device); if (ret) pr_err(KERN_ERR "misc_register failed - light\n"); gp2a->lightsensor_class = class_create(THIS_MODULE, "lightsensor"); if (IS_ERR(gp2a->lightsensor_class)) pr_err("Failed to create class(lightsensor)!\n"); gp2a->switch_cmd_dev = device_create(gp2a->lightsensor_class, NULL, 0, NULL, "switch_cmd"); if (IS_ERR(gp2a->switch_cmd_dev)) pr_err("Failed to create device(switch_cmd_dev)!\n"); if (device_create_file(gp2a->switch_cmd_dev, &dev_attr_lightsensor_file_state) < 0) pr_err("Failed to create device file(%s)!\n", dev_attr_lightsensor_file_state.attr.name); dev_set_drvdata(gp2a->switch_cmd_dev, gp2a); /* set initial proximity value as 1 */ input_report_abs(gp2a->proximity_input_dev, ABS_DISTANCE, 1); input_sync(gp2a->proximity_input_dev); goto done; /* error, unwind it all */ err_sysfs_create_group_light: input_unregister_device(gp2a->light_input_dev); err_input_register_device_light: err_input_allocate_device_light: destroy_workqueue(gp2a->wq); err_platform_allocate_device_adc: platform_device_unregister(gp2a->pdev_gp2a_adc); err_platform_register_device_adc: s3c_adc_release(gp2a->padc); err_create_workqueue: sysfs_remove_group(&gp2a->proximity_input_dev->dev.kobj, &proximity_attribute_group); err_sysfs_create_group_proximity: input_unregister_device(gp2a->proximity_input_dev); err_input_register_device_proximity: err_input_allocate_device_proximity: free_irq(gp2a->irq, gp2a); gpio_free(gp2a->pdata->p_out); err_setup_irq: mutex_destroy(&gp2a->power_lock); mutex_destroy(&gp2a->adc_lock); wake_lock_destroy(&gp2a->prx_wake_lock); kfree(gp2a); done: return ret; } static int gp2a_suspend(struct device *dev) { /* We disable power only if proximity is disabled. If proximity * is enabled, we leave power on because proximity is allowed * to wake up device. We remove power without changing * gp2a->power_state because we use that state in resume */ struct i2c_client *client = to_i2c_client(dev); struct gp2a_data *gp2a = i2c_get_clientdata(client); if (gp2a->power_state & LIGHT_ENABLED) gp2a_light_disable(gp2a); #if defined(CONFIG_MACH_Q1_BD) if (gp2a->power_state == LIGHT_ENABLED) gp2a->pdata->power(false); #endif return 0; } static int gp2a_resume(struct device *dev) { /* Turn power back on if we were before suspend. */ struct i2c_client *client = to_i2c_client(dev); struct gp2a_data *gp2a = i2c_get_clientdata(client); #if defined(CONFIG_MACH_Q1_BD) if (gp2a->power_state == LIGHT_ENABLED) gp2a->pdata->power(true); #endif if (gp2a->power_state & LIGHT_ENABLED) gp2a_light_enable(gp2a); return 0; } static int gp2a_i2c_remove(struct i2c_client *client) { struct gp2a_data *gp2a = i2c_get_clientdata(client); sysfs_remove_group(&gp2a->light_input_dev->dev.kobj, &light_attribute_group); input_unregister_device(gp2a->light_input_dev); sysfs_remove_group(&gp2a->proximity_input_dev->dev.kobj, &proximity_attribute_group); input_unregister_device(gp2a->proximity_input_dev); platform_device_unregister(gp2a->pdev_gp2a_adc); free_irq(gp2a->irq, gp2a); gpio_free(gp2a->pdata->p_out); if (gp2a->power_state) { if (gp2a->power_state & LIGHT_ENABLED) gp2a_light_disable(gp2a); #if defined(CONFIG_MACH_Q1_BD) gp2a->pdata->power(false); #endif } destroy_workqueue(gp2a->wq); mutex_destroy(&gp2a->power_lock); mutex_destroy(&gp2a->adc_lock); wake_lock_destroy(&gp2a->prx_wake_lock); s3c_adc_release(gp2a->padc); kfree(gp2a); return 0; } static const struct i2c_device_id gp2a_device_id[] = { {"gp2a", 0}, {} }; MODULE_DEVICE_TABLE(i2c, gp2a_device_id); static const struct dev_pm_ops gp2a_pm_ops = { .suspend = gp2a_suspend, .resume = gp2a_resume }; static struct i2c_driver gp2a_i2c_driver = { .driver = { .name = "gp2a", .owner = THIS_MODULE, .pm = &gp2a_pm_ops }, .probe = gp2a_i2c_probe, .remove = gp2a_i2c_remove, .id_table = gp2a_device_id, }; static int __init gp2a_init(void) { return i2c_add_driver(&gp2a_i2c_driver); } static void __exit gp2a_exit(void) { i2c_del_driver(&gp2a_i2c_driver); } module_init(gp2a_init); module_exit(gp2a_exit); MODULE_AUTHOR("mjchen@sta.samsung.com"); MODULE_DESCRIPTION("Optical Sensor driver for gp2ap002a00f"); MODULE_LICENSE("GPL");