From 8e4bff4cab0ddac6060645b0715210484d02ff40 Mon Sep 17 00:00:00 2001
From: Yuval Adam <_@yuv.al>
Date: Wed, 30 Aug 2017 08:25:59 +0000
Subject: Initial file dump from open source release

---
 drivers/media/sprd_sensor/compat_sensor_drv_k.c | 213 ++++++++++++++++++++++++
 1 file changed, 213 insertions(+)
 create mode 100644 drivers/media/sprd_sensor/compat_sensor_drv_k.c

(limited to 'drivers/media/sprd_sensor/compat_sensor_drv_k.c')

diff --git a/drivers/media/sprd_sensor/compat_sensor_drv_k.c b/drivers/media/sprd_sensor/compat_sensor_drv_k.c
new file mode 100644
index 00000000..f17613d4
--- /dev/null
+++ b/drivers/media/sprd_sensor/compat_sensor_drv_k.c
@@ -0,0 +1,213 @@
+/*
+ * Copyright (C) 2012 Spreadtrum Communications Inc.
+ *
+ * This software is licensed under the terms of the GNU General Public
+ * License version 2, as published by the Free Software Foundation, and
+ * may be copied, distributed, and modified under those terms.
+ *
+ * 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 <linux/compat.h>
+#include <linux/fs.h>
+#include <linux/uaccess.h>
+#include <video/sensor_drv_k.h>
+#include "compat_sensor_drv_k.h"
+
+//#define DEBUG_COMPAT_SENSOR_DRV
+#ifdef  DEBUG_COMPAT_SENSOR_DRV
+#define COMPAT_SENSOR_PRINT                      printk
+#else
+#define COMPAT_SENSOR_PRINT(...)
+#endif
+
+struct compat_sensor_reg_tab_tag {
+	compat_caddr_t sensor_reg_tab_ptr;
+	uint32_t reg_count;
+	uint32_t reg_bits;
+	uint32_t burst_mode;
+};
+
+struct compat_sensor_i2c_tag {
+	compat_caddr_t i2c_data;
+	uint16_t i2c_count;
+	uint16_t slave_addr;
+};
+
+struct compat_sensor_otp_data_info_tag {
+	uint32_t size;
+	compat_caddr_t data_ptr;
+};
+
+struct compat_sensor_otp_param_tag {
+	uint32_t start_addr;
+	uint32_t len;
+	compat_caddr_t buff;
+	struct compat_sensor_otp_data_info_tag golden;
+	struct compat_sensor_otp_data_info_tag awb;
+	struct compat_sensor_otp_data_info_tag lsc;
+	uint32_t type;
+};
+
+#define COMPAT_SENSOR_IO_I2C_WRITE_REGS    _IOW(SENSOR_IOC_MAGIC,  14, struct compat_sensor_reg_tab_tag)
+#define COMPAT_SENSOR_IO_I2C_WRITE_EXT     _IOW(SENSOR_IOC_MAGIC,  17, struct compat_sensor_i2c_tag)
+#define COMPAT_SENSOR_IO_I2C_READ_EXT      _IOWR(SENSOR_IOC_MAGIC, 20, struct compat_sensor_i2c_tag)
+#define COMPAT_SENSOR_IO_READ_OTPDATA      _IOWR(SENSOR_IOC_MAGIC, 254,struct compat_sensor_otp_param_tag)
+
+static long compat_get_sensor_reg_tab_tag(
+			struct compat_sensor_reg_tab_tag __user *data32,
+			struct sensor_reg_tab_tag __user *data)
+{
+	compat_caddr_t c;
+	uint32_t i;
+	int err;
+
+	err = get_user(c, &data32->sensor_reg_tab_ptr);
+	err |= put_user(c, &data->sensor_reg_tab_ptr);
+	err |= get_user(i, &data32->reg_count);
+	err |= put_user(i, &data->reg_count);
+	err |= get_user(i, &data32->reg_bits);
+	err |= put_user(i, &data->reg_bits);
+	err |= get_user(i, &data32->burst_mode);
+	err |= put_user(i, &data->burst_mode);
+
+	COMPAT_SENSOR_PRINT("sensor_reg_tab_ptr: %p reg_count: %d reg_bits: %d burst_mode: %d\n",
+		data->sensor_reg_tab_ptr, data->reg_count, data->reg_bits, data->burst_mode);
+	return err;
+}
+
+
+static long compat_get_sensor_i2c_tag(
+			struct compat_sensor_i2c_tag __user *data32,
+			struct sensor_i2c_tag __user *data)
+{
+	compat_caddr_t c;
+	uint16_t i;
+	int err;
+
+	err = get_user(c, &data32->i2c_data);
+	err |= put_user(c, &data->i2c_data);
+	err |= get_user(i, &data32->i2c_count);
+	err |= put_user(i, &data->i2c_count);
+	err |= get_user(i, &data32->slave_addr);
+	err |= put_user(i, &data->slave_addr);
+
+	COMPAT_SENSOR_PRINT("i2c_data: %p i2c_count: %d slave_addr: %d\n",
+		data->i2c_data, data->i2c_count, data->slave_addr);
+	return err;
+}
+
+static long compat_get_otp_param_tag(
+			struct compat_sensor_otp_param_tag __user *data32,
+			struct _sensor_otp_param_tag __user *data)
+{
+	compat_caddr_t c;
+	uint32_t i;
+	int err;
+
+	err = get_user(i, &data32->start_addr);
+	err |= put_user(i, &data->start_addr);
+	err |= get_user(i, &data32->len);
+	err |= put_user(i, &data->len);
+	err |= get_user(c, &data32->buff);
+	err |= put_user(c, &data->buff);
+
+	err |= get_user(c, &data32->awb.data_ptr);
+	err |= put_user(c, &data->awb.data_ptr);
+	err |= get_user(i, &data32->awb.size);
+	err |= put_user(i, &data->awb.size);
+
+	err |= get_user(c, &data32->lsc.data_ptr);
+	err |= put_user(c, &data->lsc.data_ptr);
+	err |= get_user(i, &data32->lsc.size);
+	err |= put_user(i, &data->lsc.size);
+	return err;
+}
+
+long compat_sensor_k_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
+{
+	int compatible_arg = 1;
+	long err = 0;
+
+	if (!filp->f_op || !filp->f_op->unlocked_ioctl)
+		return -ENOTTY;
+
+	switch (cmd) {
+	case COMPAT_SENSOR_IO_I2C_WRITE_REGS:
+	{
+		struct compat_sensor_reg_tab_tag __user *data32;
+		struct sensor_reg_tab_tag __user *data;
+
+		data32 = compat_ptr(arg);
+		data = compat_alloc_user_space(sizeof(*data));
+		if (NULL == data)
+			return -EFAULT;
+
+		err = compat_get_sensor_reg_tab_tag(data32, data);
+		if (err)
+			return err;
+		return filp->f_op->unlocked_ioctl(filp, SENSOR_IO_I2C_WRITE_REGS,
+								(unsigned long)data);
+	}
+
+	case COMPAT_SENSOR_IO_I2C_WRITE_EXT:
+	{
+		struct compat_sensor_i2c_tag __user *data32;
+		struct sensor_i2c_tag __user *data;
+
+		data32 = compat_ptr(arg);
+		data = compat_alloc_user_space(sizeof(*data));
+		if (NULL == data)
+			return -EFAULT;
+
+		err = compat_get_sensor_i2c_tag(data32, data);
+		if (err)
+			return err;
+		return filp->f_op->unlocked_ioctl(filp, SENSOR_IO_I2C_WRITE_EXT,
+								(unsigned long)data);
+	}
+
+	case COMPAT_SENSOR_IO_I2C_READ_EXT:
+	{
+		struct compat_sensor_i2c_tag __user *data32;
+		struct sensor_i2c_tag __user *data;
+
+		data32 = compat_ptr(arg);
+		data = compat_alloc_user_space(sizeof(*data));
+		if (NULL == data)
+			return -EFAULT;
+
+		err = compat_get_sensor_i2c_tag(data32, data);
+		if (err)
+			return err;
+		return filp->f_op->unlocked_ioctl(filp, SENSOR_IO_I2C_READ_EXT,
+								(unsigned long)data);
+	}
+
+	case COMPAT_SENSOR_IO_READ_OTPDATA:
+	{
+		struct compat_sensor_otp_param_tag __user *data32;
+		SENSOR_OTP_PARAM_T __user *data;
+
+		printk("SENSOR: ioctl COMPAT_SENSOR_IO_READ_OTPDATA \n");
+		data32 = compat_ptr(arg);
+		data = compat_alloc_user_space(sizeof(*data));
+		if (NULL == data)
+			return -EFAULT;
+
+		err = compat_get_otp_param_tag(data32, data);
+		if (err)
+			return err;
+		return filp->f_op->unlocked_ioctl(filp, SENSOR_IO_READ_OTPDATA,
+								(unsigned long)data);
+	}
+	break;
+
+	default:
+		return filp->f_op->unlocked_ioctl(filp, cmd,
+						(unsigned long)compat_ptr(arg));
+	}
+}
-- 
cgit v1.3.1