aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/sensor/gp2a_proximity.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/sensor/gp2a_proximity.c')
-rw-r--r--drivers/sensor/gp2a_proximity.c226
1 files changed, 221 insertions, 5 deletions
diff --git a/drivers/sensor/gp2a_proximity.c b/drivers/sensor/gp2a_proximity.c
index 8ac0d2a..012d8b8 100644
--- a/drivers/sensor/gp2a_proximity.c
+++ b/drivers/sensor/gp2a_proximity.c
@@ -39,10 +39,14 @@
#include <linux/gpio.h>
#include <mach/gpio-midas.h>
#include <linux/sensor/sensors_core.h>
+#include <linux/printk.h>
/*********** for debug *******************************/
#undef DEBUG
+#define VENDOR "SHARP"
+#define CHIP_ID "GP2AP"
+
#if 1
#define gprintk(fmt, x...) printk(KERN_INFO "%s(%d): "\
fmt, __func__ , __LINE__, ## x)
@@ -52,6 +56,11 @@ fmt, __func__ , __LINE__, ## x)
/**************************************************/
#define PROX_READ_NUM 40
+#define PS_LOW_THD_L 0x08
+#define PS_LOW_THD_H 0x09
+#define PS_HIGH_THD_L 0x0A
+#define PS_HIGH_THD_H 0x0B
+
/* global var */
static struct i2c_driver opt_i2c_driver;
static struct i2c_client *opt_i2c_client;
@@ -128,12 +137,69 @@ static int proximity_onoff(u8 onoff);
int is_gp2a030a(void)
{
-#if defined(CONFIG_MACH_C1) || defined(CONFIG_MACH_C1VZW) || \
- defined(CONFIG_MACH_M0) || defined(CONFIG_MACH_M3)
+#if defined(CONFIG_MACH_C1) || \
+ defined(CONFIG_MACH_M0) || \
+ defined(CONFIG_MACH_GRANDE) || \
+ defined(CONFIG_MACH_IRON)
return (system_rev != 0 && system_rev != 3);
#endif
+#if defined(CONFIG_MACH_M3) || \
+ defined(CONFIG_MACH_BAFFIN)
+ return 1;
+#endif
+#if defined(CONFIG_MACH_REDWOOD)
+ return (system_rev == 0x04);
+#endif
+
return 0;
}
+
+static int gp2a_update_threshold(u8 (*selected_image)[2],
+ unsigned long new_threshold, bool update_reg)
+{
+ int i, err = 0;
+ u8 set_value;
+
+ for (i = 0; i < COL; i++) {
+ switch (selected_image[i][0]) {
+ case PS_LOW_THD_L:
+ /*PS mode LTH(Loff) for low 8bit*/
+ set_value = new_threshold & 0x00FF;
+ break;
+
+ case PS_LOW_THD_H:
+ /*PS mode LTH(Loff) for high 8bit*/
+ set_value = (new_threshold & 0xFF00) >> 8;
+ break;
+
+ case PS_HIGH_THD_L:
+ /*PS mode HTH(Lon) for low 8bit*/
+ set_value = (new_threshold+1) & 0x00FF;
+ break;
+
+ case PS_HIGH_THD_H:
+ /* PS mode HTH(Lon) for high 8bit*/
+ set_value = ((new_threshold+1) & 0xFF00) >> 8;
+ break;
+
+ default:
+ continue;
+ }
+
+ if (update_reg)
+ err = opt_i2c_write(selected_image[i][0], &set_value);
+
+ if (err) {
+ pr_err("%s : setting error i = %d, err=%d\n",
+ __func__, i, err);
+ return err;
+ } else
+ selected_image[i][1] = set_value;
+ }
+
+ return err;
+}
+
/* Proximity Sysfs interface */
static ssize_t
proximity_enable_show(struct device *dev,
@@ -173,9 +239,7 @@ proximity_enable_store(struct device *dev,
proximity_enable = value;
proximity_onoff(0);
disable_irq_wake(data->irq);
-#ifndef CONFIG_MACH_MIDAS_02_BD
data->pdata->gp2a_led_on(false);
-#endif
} else if (!data->enabled && value) { /* proximity power on */
data->pdata->gp2a_led_on(true);
/*msleep(1); */
@@ -261,13 +325,65 @@ static ssize_t proximity_avg_store(struct device *dev,
return size;
}
+static ssize_t proximity_thresh_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ int i;
+ int threshold = 0;
+ u8 (*selected_image)[2] = (is_gp2a030a() ?
+ gp2a_original_image_030a : gp2a_original_image);
+
+ for (i = 0; i < COL; i++) {
+ if (selected_image[i][0] == 0x08)
+ /*PS mode LTH(Loff) */
+ threshold = selected_image[i][1];
+ else if (selected_image[i][0] == 0x09)
+ /*PS mode LTH(Loff) */
+ threshold |= selected_image[i][1]<<8;
+ }
+
+ return sprintf(buf, "prox_threshold = %d\n", threshold);
+}
+
+static ssize_t proximity_thresh_store(struct device *dev,
+ struct device_attribute *attr,
+ const char *buf, size_t size)
+{
+ unsigned long threshold;
+ int err = 0;
+
+ err = strict_strtoul(buf, 10, &threshold);
+
+ if (err) {
+ pr_err("%s, conversion %s to number.\n",
+ __func__, buf);
+ return err;
+ }
+
+ err = gp2a_update_threshold(is_gp2a030a() ?
+ gp2a_original_image_030a : gp2a_original_image,
+ threshold, true);
+
+ if (err) {
+ pr_err("gp2a threshold(with register) update fail.\n");
+ return err;
+ }
+
+ return size;
+}
+
static DEVICE_ATTR(enable, 0664, proximity_enable_show, proximity_enable_store);
static DEVICE_ATTR(prox_avg, 0664, proximity_avg_show, proximity_avg_store);
static DEVICE_ATTR(state, 0664, proximity_state_show, NULL);
+static DEVICE_ATTR(prox_thresh, S_IRUGO | S_IWUSR,
+ proximity_thresh_show, proximity_thresh_store);
static struct attribute *proximity_attributes[] = {
&dev_attr_enable.attr,
&dev_attr_state.attr,
+#ifdef CONFIG_SLP
+ &dev_attr_prox_thresh.attr,
+#endif
NULL
};
@@ -275,6 +391,38 @@ static struct attribute_group proximity_attribute_group = {
.attrs = proximity_attributes
};
+/* sysfs for vendor & name */
+static ssize_t proximity_vendor_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ return sprintf(buf, "%s\n", VENDOR);
+}
+
+static ssize_t proximity_name_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+
+ return is_gp2a030a() ? sprintf(buf, "%s030\n", CHIP_ID)
+ : sprintf(buf, "%s020\n", CHIP_ID);
+}
+
+static ssize_t proximity_raw_data_show(struct device *dev,
+ struct device_attribute *attr, char *buf)
+{
+ int D2_data = 0;
+ unsigned char get_D2_data[2] = { 0, };
+
+ msleep(20);
+ opt_i2c_read(0x10, get_D2_data, sizeof(get_D2_data));
+ D2_data = (get_D2_data[1] << 8) | get_D2_data[0];
+
+ return sprintf(buf, "%d\n", D2_data);
+}
+
+static DEVICE_ATTR(vendor, 0644, proximity_vendor_show, NULL);
+static DEVICE_ATTR(name, 0644, proximity_name_show, NULL);
+static DEVICE_ATTR(raw_data, 0644, proximity_raw_data_show, NULL);
+
static void proxsensor_get_avgvalue(struct gp2a_data *data)
{
int min = 0, max = 0, avg = 0;
@@ -324,6 +472,9 @@ irqreturn_t gp2a_irq_handler(int irq, void *gp2a_data_p)
struct gp2a_data *data = gp2a_data_p;
wake_lock_timeout(&data->prx_wake_lock, 3 * HZ);
+#ifdef CONFIG_SLP
+ pm_wakeup_event(data->proximity_dev, 0);
+#endif
schedule_work(&data->work);
@@ -564,6 +715,12 @@ static int gp2a_opt_probe(struct platform_device *pdev)
/* gp2a power on */
pdata->gp2a_led_on(true);
+ if (pdata->gp2a_get_threshold) {
+ gp2a_update_threshold(is_gp2a030a() ?
+ gp2a_original_image_030a : gp2a_original_image,
+ pdata->gp2a_get_threshold(), false);
+ }
+
/* allocate driver_data */
gp2a = kzalloc(sizeof(struct gp2a_data), GFP_KERNEL);
if (!gp2a) {
@@ -653,6 +810,37 @@ static int gp2a_opt_probe(struct platform_device *pdev)
dev_attr_prox_avg.attr.name);
goto err_proximity_device_create_file2;
}
+
+ if (device_create_file(gp2a->proximity_dev,
+ &dev_attr_prox_thresh) < 0) {
+ pr_err("%s: could not create device file(%s)!\n", __func__,
+ dev_attr_prox_thresh.attr.name);
+ goto err_proximity_device_create_file3;
+ }
+
+ if (device_create_file(gp2a->proximity_dev,
+ &dev_attr_vendor) < 0) {
+ pr_err("%s: could not create device file(%s)!\n", __func__,
+ dev_attr_vendor.attr.name);
+ goto err_proximity_device_create_file4;
+ }
+
+ if (device_create_file(gp2a->proximity_dev,
+ &dev_attr_name) < 0) {
+ pr_err("%s: could not create device file(%s)!\n", __func__,
+ dev_attr_name.attr.name);
+ goto err_proximity_device_create_file5;
+ }
+
+ if (device_create_file(gp2a->proximity_dev, &dev_attr_raw_data) < 0) {
+ pr_err("%s: could not create device file(%s)!\n", __func__,
+ dev_attr_raw_data.attr.name);
+ goto err_proximity_device_create_file6;
+ }
+
+#ifdef CONFIG_SLP
+ device_init_wakeup(gp2a->proximity_dev, true);
+#endif
dev_set_drvdata(gp2a->proximity_dev, gp2a);
device_init_wakeup(&pdev->dev, 1);
@@ -661,6 +849,14 @@ static int gp2a_opt_probe(struct platform_device *pdev)
return 0;
+err_proximity_device_create_file6:
+ device_remove_file(gp2a->proximity_dev, &dev_attr_raw_data);
+err_proximity_device_create_file5:
+ device_remove_file(gp2a->proximity_dev, &dev_attr_name);
+err_proximity_device_create_file4:
+ device_remove_file(gp2a->proximity_dev, &dev_attr_vendor);
+err_proximity_device_create_file3:
+ device_remove_file(gp2a->proximity_dev, &dev_attr_prox_avg);
err_proximity_device_create_file2:
device_remove_file(gp2a->proximity_dev, &dev_attr_state);
err_proximity_device_create_file1:
@@ -690,8 +886,29 @@ static int gp2a_opt_remove(struct platform_device *pdev)
return -1;
}
+ if (gp2a->enabled) {
+ disable_irq(gp2a->irq);
+ proximity_enable = 0;
+ proximity_onoff(0);
+ disable_irq_wake(gp2a->irq);
+#ifndef CONFIG_MACH_MIDAS_02_BD
+ gp2a->pdata->gp2a_led_on(false);
+#endif
+ gp2a->enabled = 0;
+ }
+
+ hrtimer_cancel(&gp2a->prox_timer);
+ cancel_work_sync(&gp2a->work_prox);
+ destroy_workqueue(gp2a->prox_wq);
+#ifdef CONFIG_SLP
+ device_init_wakeup(gp2a->proximity_dev, false);
+#endif
+ device_remove_file(gp2a->proximity_dev, &dev_attr_prox_thresh);
device_remove_file(gp2a->proximity_dev, &dev_attr_prox_avg);
device_remove_file(gp2a->proximity_dev, &dev_attr_state);
+ device_remove_file(gp2a->proximity_dev, &dev_attr_vendor);
+ device_remove_file(gp2a->proximity_dev, &dev_attr_name);
+ device_remove_file(gp2a->proximity_dev, &dev_attr_raw_data);
sensors_classdev_unregister(gp2a->proximity_dev);
if (gp2a->input_dev != NULL) {
@@ -702,7 +919,6 @@ static int gp2a_opt_remove(struct platform_device *pdev)
kfree(gp2a->input_dev);
}
- destroy_workqueue(gp2a->prox_wq);
wake_lock_destroy(&gp2a->prx_wake_lock);
device_init_wakeup(&pdev->dev, 0);
free_irq(gp2a->irq, gp2a);
generated by cgit v1.1 at 2024-04-25 22:47:29 +0000