1 files changed, 380 insertions, 0 deletions
diff --git a/drivers/sensorhub/atmel/prox_cm36651.c b/drivers/sensorhub/atmel/prox_cm36651.c
new file mode 100755
index 00000000000..797261dbd96
--- /dev/null
+++ b/drivers/sensorhub/atmel/prox_cm36651.c
@@ -0,0 +1,380 @@
+/*
+ *  Copyright (C) 2012, Samsung Electronics Co. Ltd. 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 as published by
+ *  the Free Software Foundation; either version 2 of the License, or
+ *  (at your option) any later version.
+ *
+ *  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.
+ *
+ */
+#include "ssp.h"
+
+#define	VENDOR		"CAPELLA"
+#define	CHIP_ID		"CM36651"
+
+#define CANCELATION_FILE_PATH	"/efs/prox_cal"
+#define LCD_LDI_FILE_PATH	"/sys/class/lcd/panel/window_type"
+
+#define LINE_1		'4'
+#define LINE_2		'2'
+
+#define LDI_OTHERS	'0'
+#define LDI_GRAY	'1'
+#define LDI_WHITE	'2'
+
+#define CANCELATION_THRESHOLD		9
+#define DEFAULT_THRESHOLD		13
+#define OTHERS_OCTA_DEFAULT_THRESHOLD	14
+#define WHITE_OCTA_DEFAULT_THRESHOLD	13
+#define GRAY_OCTA_DEFAULT_THRESHOLD	12
+
+/*************************************************************************/
+/* factory Sysfs                                                         */
+/*************************************************************************/
+
+static ssize_t prox_vendor_show(struct device *dev,
+	struct device_attribute *attr, char *buf)
+{
+	return sprintf(buf, "%s\n", VENDOR);
+}
+
+static ssize_t prox_name_show(struct device *dev,
+	struct device_attribute *attr, char *buf)
+{
+	return sprintf(buf, "%s\n", CHIP_ID);
+}
+
+static ssize_t proximity_avg_show(struct device *dev,
+	struct device_attribute *attr, char *buf)
+{
+	struct ssp_data *data = dev_get_drvdata(dev);
+
+	return snprintf(buf, PAGE_SIZE, "%d,%d,%d\n",
+		data->buf[PROXIMITY_RAW].prox[1],
+		data->buf[PROXIMITY_RAW].prox[2],
+		data->buf[PROXIMITY_RAW].prox[3]);
+}
+
+static ssize_t proximity_avg_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t size)
+{
+	char chTempbuf[2] = { 1, 20};
+	int iRet;
+	int64_t dEnable;
+	struct ssp_data *data = dev_get_drvdata(dev);
+
+	iRet = kstrtoll(buf, 10, &dEnable);
+	if (iRet < 0)
+		return iRet;
+
+	if (dEnable) {
+		send_instruction(data, ADD_SENSOR, PROXIMITY_RAW, chTempbuf, 2);
+		data->bProximityRawEnabled = true;
+	} else {
+		send_instruction(data, REMOVE_SENSOR, PROXIMITY_RAW,
+			chTempbuf, 2);
+		data->bProximityRawEnabled = false;
+	}
+
+	return size;
+}
+
+static unsigned char get_proximity_rawdata(struct ssp_data *data)
+{
+	unsigned char uRowdata = 0;
+	char chTempbuf[2] = { 1, 20};
+
+	if (data->bProximityRawEnabled == false) {
+		send_instruction(data, ADD_SENSOR, PROXIMITY_RAW, chTempbuf, 2);
+		msleep(200);
+		uRowdata = data->buf[PROXIMITY_RAW].prox[0];
+		send_instruction(data, REMOVE_SENSOR, PROXIMITY_RAW,
+			chTempbuf, 2);
+	} else {
+		uRowdata = data->buf[PROXIMITY_RAW].prox[0];
+	}
+
+	return uRowdata;
+}
+
+static ssize_t proximity_state_show(struct device *dev,
+	struct device_attribute *attr, char *buf)
+{
+	struct ssp_data *data = dev_get_drvdata(dev);
+
+	return sprintf(buf, "%u\n", get_proximity_rawdata(data));
+}
+
+static void change_proximity_default_threshold(struct ssp_data *data)
+{
+	switch (data->chLcdLdi[1]) {
+	case LDI_GRAY:
+		data->uProxHiThresh = GRAY_OCTA_DEFAULT_THRESHOLD;
+		break;
+	case LDI_WHITE:
+		data->uProxHiThresh = WHITE_OCTA_DEFAULT_THRESHOLD;
+		break;
+	case LDI_OTHERS:
+		data->uProxHiThresh = OTHERS_OCTA_DEFAULT_THRESHOLD;
+		break;
+	default:
+		data->uProxHiThresh = DEFAULT_THRESHOLD;
+		break;
+	}
+}
+
+int proximity_open_lcd_ldi(struct ssp_data *data)
+{
+	int iRet = 0;
+	mm_segment_t old_fs;
+	struct file *cancel_filp = NULL;
+
+	old_fs = get_fs();
+	set_fs(KERNEL_DS);
+
+	cancel_filp = filp_open(LCD_LDI_FILE_PATH, O_RDONLY, 0666);
+	if (IS_ERR(cancel_filp)) {
+		iRet = PTR_ERR(cancel_filp);
+		if (iRet != -ENOENT)
+			pr_err("[SSP]: %s - Can't open lcd ldi file\n",
+				__func__);
+		set_fs(old_fs);
+		data->chLcdLdi[0] = 0;
+		data->chLcdLdi[1] = 0;
+		goto exit;
+	}
+
+	iRet = cancel_filp->f_op->read(cancel_filp,
+		(u8 *)data->chLcdLdi, sizeof(u8) * 2, &cancel_filp->f_pos);
+	if (iRet != (sizeof(u8) * 2)) {
+		pr_err("[SSP]: %s - Can't read the lcd ldi data\n", __func__);
+		iRet = -EIO;
+	}
+
+	ssp_dbg("[SSP]: %s - %c%c\n", __func__,
+		data->chLcdLdi[0], data->chLcdLdi[1]);
+
+	filp_close(cancel_filp, current->files);
+	set_fs(old_fs);
+
+exit:
+	change_proximity_default_threshold(data);
+	return iRet;
+}
+
+int proximity_open_calibration(struct ssp_data *data)
+{
+	int iRet = 0;
+	mm_segment_t old_fs;
+	struct file *cancel_filp = NULL;
+
+	old_fs = get_fs();
+	set_fs(KERNEL_DS);
+
+	cancel_filp = filp_open(CANCELATION_FILE_PATH, O_RDONLY, 0666);
+	if (IS_ERR(cancel_filp)) {
+		iRet = PTR_ERR(cancel_filp);
+		if (iRet != -ENOENT)
+			pr_err("[SSP]: %s - Can't open cancelation file\n",
+				__func__);
+		set_fs(old_fs);
+		goto exit;
+	}
+
+	iRet = cancel_filp->f_op->read(cancel_filp,
+		(u8 *)&data->uProxCanc, sizeof(u8), &cancel_filp->f_pos);
+	if (iRet != sizeof(u8)) {
+		pr_err("[SSP]: %s - Can't read the cancel data\n", __func__);
+		iRet = -EIO;
+	}
+
+	if (data->uProxCanc != 0) /* If there is an offset cal data. */
+		data->uProxHiThresh = CANCELATION_THRESHOLD;
+
+	pr_info("%s: proximity ps_canc = %d, ps_thresh = %d\n",
+		__func__, data->uProxCanc, data->uProxHiThresh);
+
+	filp_close(cancel_filp, current->files);
+	set_fs(old_fs);
+
+exit:
+	set_proximity_threshold(data, data->uProxHiThresh, data->uProxCanc);
+
+	return iRet;
+}
+
+static int proximity_store_cancelation(struct ssp_data *data, int iCalCMD)
+{
+	int iRet = 0;
+	mm_segment_t old_fs;
+	struct file *cancel_filp = NULL;
+
+	if (iCalCMD) {
+		data->uProxHiThresh = CANCELATION_THRESHOLD;
+		data->uProxCanc = get_proximity_rawdata(data);
+	} else {
+		change_proximity_default_threshold(data);
+		data->uProxCanc = 0;
+	}
+
+	set_proximity_threshold(data, data->uProxHiThresh, data->uProxCanc);
+
+	old_fs = get_fs();
+	set_fs(KERNEL_DS);
+
+	cancel_filp = filp_open(CANCELATION_FILE_PATH,
+			O_CREAT | O_TRUNC | O_WRONLY | O_SYNC, 0666);
+	if (IS_ERR(cancel_filp)) {
+		pr_err("%s: Can't open cancelation file\n", __func__);
+		set_fs(old_fs);
+		iRet = PTR_ERR(cancel_filp);
+		return iRet;
+	}
+
+	iRet = cancel_filp->f_op->write(cancel_filp, (u8 *)&data->uProxCanc,
+		sizeof(u8), &cancel_filp->f_pos);
+	if (iRet != sizeof(u8)) {
+		pr_err("%s: Can't write the cancel data to file\n", __func__);
+		iRet = -EIO;
+	}
+
+	filp_close(cancel_filp, current->files);
+	set_fs(old_fs);
+
+	return iRet;
+}
+
+static ssize_t proximity_cancel_show(struct device *dev,
+	struct device_attribute *attr, char *buf)
+{
+	struct ssp_data *data = dev_get_drvdata(dev);
+
+	ssp_dbg("[SSP]: uProxThresh = %u, uProxCanc = %u\n",
+		data->uProxHiThresh, data->uProxCanc);
+
+	return sprintf(buf, "%u,%u\n", data->uProxCanc, data->uProxHiThresh);
+}
+
+static ssize_t proximity_cancel_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t size)
+{
+	int iCalCMD = 0, iRet = 0;
+	struct ssp_data *data = dev_get_drvdata(dev);
+
+	if (sysfs_streq(buf, "1")) /* calibrate cancelation value */
+		iCalCMD = 1;
+	else if (sysfs_streq(buf, "0")) /* reset cancelation value */
+		iCalCMD = 0;
+	else {
+		pr_debug("%s: invalid value %d\n", __func__, *buf);
+		return -EINVAL;
+	}
+
+	iRet = proximity_store_cancelation(data, iCalCMD);
+	if (iRet < 0) {
+		pr_err("[SSP]: - %s proximity_store_cancelation() failed\n",
+			__func__);
+		return iRet;
+	}
+
+	ssp_dbg("[SSP]: %s - %u\n", __func__, iCalCMD);
+	return size;
+}
+
+static ssize_t proximity_thresh_show(struct device *dev,
+	struct device_attribute *attr, char *buf)
+{
+	struct ssp_data *data = dev_get_drvdata(dev);
+
+	ssp_dbg("[SSP]: uProxThresh = %u\n", data->uProxHiThresh);
+
+	return sprintf(buf, "%u\n", data->uProxHiThresh);
+}
+
+static ssize_t proximity_thresh_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t size)
+{
+	u8 uNewThresh = 0x09;
+	int iRet = 0;
+	struct ssp_data *data = dev_get_drvdata(dev);
+
+	iRet = kstrtou8(buf, 10, &uNewThresh);
+	if (iRet < 0)
+		pr_err("[SSP]: %s - kstrtoint failed.", __func__);
+
+	data->uProxHiThresh = uNewThresh;
+	set_proximity_threshold(data, data->uProxHiThresh, data->uProxCanc);
+
+	ssp_dbg("[SSP]: %s - new prox threshold = 0x%x\n",
+		__func__, data->uProxHiThresh);
+
+	return size;
+}
+
+static ssize_t barcode_emul_enable_show(struct device *dev,
+	struct device_attribute *attr, char *buf)
+{
+	struct ssp_data *data = dev_get_drvdata(dev);
+
+	return snprintf(buf, PAGE_SIZE, "%u\n", data->bBarcodeEnabled);
+}
+
+static ssize_t barcode_emul_enable_store(struct device *dev,
+	struct device_attribute *attr, const char *buf, size_t size)
+{
+	int iRet;
+	int64_t dEnable;
+	struct ssp_data *data = dev_get_drvdata(dev);
+
+	iRet = kstrtoll(buf, 10, &dEnable);
+	if (iRet < 0)
+		return iRet;
+
+	if (dEnable)
+		set_proximity_barcode_enable(data, true);
+	else
+		set_proximity_barcode_enable(data, false);
+
+	return size;
+}
+
+static DEVICE_ATTR(vendor, S_IRUGO, prox_vendor_show, NULL);
+static DEVICE_ATTR(name, S_IRUGO, prox_name_show, NULL);
+static DEVICE_ATTR(state, S_IRUGO, proximity_state_show, NULL);
+static DEVICE_ATTR(raw_data, S_IRUGO, proximity_state_show, NULL);
+static DEVICE_ATTR(barcode_emul_en, S_IRUGO | S_IWUSR | S_IWGRP,
+	barcode_emul_enable_show, barcode_emul_enable_store);
+static DEVICE_ATTR(prox_avg, S_IRUGO | S_IWUSR | S_IWGRP,
+	proximity_avg_show, proximity_avg_store);
+static DEVICE_ATTR(prox_cal, S_IRUGO | S_IWUSR | S_IWGRP,
+	proximity_cancel_show, proximity_cancel_store);
+static DEVICE_ATTR(prox_thresh, S_IRUGO | S_IWUSR | S_IWGRP,
+	proximity_thresh_show, proximity_thresh_store);
+
+static struct device_attribute *prox_attrs[] = {
+	&dev_attr_vendor,
+	&dev_attr_name,
+	&dev_attr_state,
+	&dev_attr_raw_data,
+	&dev_attr_prox_avg,
+	&dev_attr_prox_cal,
+	&dev_attr_prox_thresh,
+	&dev_attr_barcode_emul_en,
+	NULL,
+};
+
+void initialize_prox_factorytest(struct ssp_data *data)
+{
+	sensors_register(data->prox_device, data,
+		prox_attrs, "proximity_sensor");
+}
+
+void remove_prox_factorytest(struct ssp_data *data)
+{
+	sensors_unregister(data->prox_device, prox_attrs);
+}