summaryrefslogtreecommitdiff
path: root/drivers/media/sprd_isp/compat_isp_drv_kernel.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/media/sprd_isp/compat_isp_drv_kernel.c')
-rw-r--r--drivers/media/sprd_isp/compat_isp_drv_kernel.c327
1 files changed, 327 insertions, 0 deletions
diff --git a/drivers/media/sprd_isp/compat_isp_drv_kernel.c b/drivers/media/sprd_isp/compat_isp_drv_kernel.c
new file mode 100644
index 00000000..ae0ad4f0
--- /dev/null
+++ b/drivers/media/sprd_isp/compat_isp_drv_kernel.c
@@ -0,0 +1,327 @@
+#include <linux/compat.h>
+#include <linux/fs.h>
+#include <linux/uaccess.h>
+#include <video/isp_drv_kernel.h>
+#include "compat_isp_drv_kernel.h"
+
+struct compat_isp_irq_param {
+ compat_uint_t isp_irq_val;
+ compat_uint_t dcam_irq_val;
+ compat_uint_t irq_val;
+ compat_int_t ret_val;
+};
+
+struct compat_isp_reg_bits {
+ compat_ulong_t reg_addr;
+ compat_ulong_t reg_value;
+} ;
+
+struct compat_isp_reg_param {
+ compat_ulong_t reg_param;
+ uint32_t counts;
+} ;
+
+
+#define COMPAT_ISP_IO_READ _IOR(ISP_IO_MAGIC, 1, struct compat_isp_reg_param)
+#define COMPAT_ISP_IO_WRITE _IOW(ISP_IO_MAGIC, 2, struct compat_isp_reg_param)
+#define COMPAT_ISP_IO_LNC_PARAM _IOW(ISP_IO_MAGIC, 8, struct compat_isp_reg_param)
+#define COMPAT_ISP_IO_LNC _IOW(ISP_IO_MAGIC, 9, struct compat_isp_reg_param)
+#define COMPAT_ISP_IO_ALLOC _IOW(ISP_IO_MAGIC, 10, struct compat_isp_reg_param)
+
+
+static int compat_get_rw_param(
+ struct compat_isp_reg_param __user *data32,
+ struct isp_reg_param __user *data)
+{
+ int err = 0;
+ compat_ulong_t addr;
+ uint32_t cnt;
+
+ err = get_user(addr, &data32->reg_param);
+ err |= put_user(addr, &data->reg_param);
+ err |= get_user(cnt, &data32->counts);
+ err |= put_user(cnt, &data->counts);
+
+ //printk("compat_get_rw_param, addr: 0x%x data32->reg_param: 0x%x data->reg_param: 0x%lx cnt: %d\n",
+ // addr, data32->reg_param, data->reg_param, cnt);
+
+ return err;
+}
+
+static int compat_get_rw_param_detail(struct isp_reg_param __user *data)
+{
+ struct compat_isp_reg_bits __user *data32;
+ struct isp_reg_bits __user *reg_data;
+ int err = 0;
+ int i = 0;
+ int cnt = data->counts;
+ compat_ulong_t addr;
+ compat_ulong_t val;
+ struct isp_reg_bits __user *data_tmp;
+
+ data32 = compat_ptr(data->reg_param);
+// printk("compat_get_rw_param_detail param: %p cnt %d\n", data32, cnt);
+ reg_data = (struct isp_reg_bits __user*)((unsigned long)data + sizeof(struct isp_reg_param));
+ data->reg_param = reg_data;
+ if (reg_data == NULL) {
+ printk("compat_isp_k failed to compat_alloc_user_space \n");
+ return -EFAULT;
+ }
+// printk("compat_get_rw_param_detail param: data %p \n", reg_data);
+ data_tmp = reg_data;
+ for (i=0 ; i< cnt; i++) {
+ err = get_user(addr, &data32->reg_addr);
+ err |= put_user(addr, &data_tmp->reg_addr);
+ err |= get_user(val, &data32->reg_value);
+ err |= put_user(val, &data_tmp->reg_value);
+ if (err) {
+ printk("compat_isp_k, read_param_detail failed cnt %d ret %d\n", cnt, err);
+ break;
+ }
+ data32++;
+ data_tmp++;
+ }
+ return err;
+}
+
+static int compat_put_read_param(
+ struct compat_isp_reg_param __user *data32,
+ struct isp_reg_param __user *data)
+
+{
+ int err = 0;
+ compat_ulong_t val;
+ uint32_t cnt;
+ int i = 0;
+ struct compat_isp_reg_bits __user *reg_data32;
+ struct isp_reg_bits __user *reg_data;
+
+ cnt = data->counts;
+ reg_data32 = (struct compat_isp_reg_bits __user *)data32->reg_param;
+ reg_data = (struct isp_reg_bits __user *)data->reg_param;
+ for (i=0 ; i<cnt; i++) {
+ err = get_user(val, &reg_data->reg_value);
+ err |= put_user(val, &reg_data32->reg_value);
+ if (err) {
+ printk("compat_isp_k, compat_put_read_param ret %d\n", err);
+ break;
+ }
+ reg_data32++;
+ reg_data++;
+ }
+
+ return err;
+}
+
+static int compat_get_alloc_param(
+ struct compat_isp_reg_param __user *data32,
+ struct isp_reg_param __user *data)
+{
+ int err = 0;
+ compat_ulong_t addr;
+ uint32_t cnt;
+ struct compat_isp_reg_bits __user *reg_data32;
+ struct isp_reg_bits __user *reg_data;
+
+ err = get_user(addr, &data32->reg_param);
+ err |= put_user(addr, &data->reg_param);
+ err |= get_user(cnt, &data32->counts);
+ err |= put_user(cnt, &data->counts);
+
+ return err;
+}
+
+static int compat_put_alloc(
+ struct compat_isp_reg_param __user *data32,
+ struct isp_reg_param __user *data)
+
+{
+ int err = 0;
+ compat_ulong_t addr;
+ uint32_t cnt;
+ struct compat_isp_reg_bits __user *reg_data32;
+ struct isp_reg_bits __user *reg_data;
+
+ err = get_user(addr, &data->reg_param);
+ err |= put_user(addr, &data32->reg_param);
+ err |= get_user(cnt, &data->counts);
+ err |= put_user(cnt, &data32->counts);
+
+ return err;
+}
+
+
+
+
+long compat_isp_kernel_ioctl( struct file *fl, unsigned int cmd, unsigned long param)
+{
+ long ret;
+ int err = 0;
+ void __user *up = compat_ptr(param);
+
+ if(ISP_IO_IRQ == cmd) {
+ ret = fl->f_op->unlocked_ioctl(fl, cmd, (unsigned long)up);
+ } else {
+ switch (cmd) {
+ case COMPAT_ISP_IO_READ:
+ {
+ struct compat_isp_reg_param __user *data32;
+ struct isp_reg_param __user *data;
+ uint32_t cnt;
+
+
+ data32 = compat_ptr(param);
+ err = get_user(cnt, &data32->counts);
+
+// printk("COMPAT_ISP_IO_WRITE param: %p \n", data32);
+ data = compat_alloc_user_space(sizeof(struct isp_reg_param)+cnt*sizeof(struct isp_reg_bits));
+ if (data == NULL) {
+ printk("compat_isp_k failed to compat_alloc_user_space \n");
+ return -EFAULT;
+ }
+// printk("@@1 %p", data);
+ err = compat_get_rw_param(data32, data);
+ if (err) {
+ return err;
+ }
+ err = compat_get_rw_param_detail(data);
+ if (err) {
+ printk("compat_isp_k error %d\n", err);
+ return err;
+ }
+ err = fl->f_op->unlocked_ioctl(fl, ISP_IO_READ, (unsigned long)data);
+ err = compat_put_read_param(data32, data);
+ ret = ret ? ret : err;
+ break;
+ }
+ case COMPAT_ISP_IO_WRITE:
+ {
+ struct compat_isp_reg_param __user *data32;
+ struct isp_reg_param __user *data;
+ uint32_t cnt;
+
+
+ data32 = compat_ptr(param);
+ err = get_user(cnt, &data32->counts);
+
+// printk("COMPAT_ISP_IO_WRITE param: %p \n", data32);
+ data = compat_alloc_user_space(sizeof(struct isp_reg_param)+cnt*sizeof(struct isp_reg_bits));
+ if (data == NULL) {
+ printk("compat_isp_k failed to compat_alloc_user_space \n");
+ return -EFAULT;
+ }
+// printk("@@1 %p", data);
+ err = compat_get_rw_param(data32, data);
+ if (err) {
+ return err;
+ }
+ err = compat_get_rw_param_detail(data);
+ if (err) {
+ printk("compat_isp_k error %d\n", err);
+ return err;
+ }
+ err = fl->f_op->unlocked_ioctl(fl, ISP_IO_WRITE, (unsigned long)data);
+ break;
+ }
+ case COMPAT_ISP_IO_LNC_PARAM:
+ {
+ struct compat_isp_reg_param __user *data32;
+ struct isp_reg_param __user *data;
+ char __user *lnc_data;
+
+
+ data32 = compat_ptr(param);
+ data = compat_alloc_user_space(sizeof(*data));
+ if (data == NULL) {
+ printk("compat_isp_k failed to compat_alloc_user_space \n");
+ return -EFAULT;
+ }
+ err = compat_get_rw_param(data32, data);
+ if (err) {
+ printk("compat_isp_k COMPAT_ISP_IO_LNC_PARAM error\n");
+ return err;
+ }
+ /*lnc_data = compat_alloc_user_space(sizeof(*lnc_data)*data->counts);
+ data->reg_param = (unsigned long)lnc_data;
+ ret = copy_from_user((void*)data->reg_param, (void*)data32->reg_param, data->counts);
+ if (ret) {
+ return ret;
+ }*/
+// printk("test 123\n");
+ ret = fl->f_op->unlocked_ioctl(fl, ISP_IO_LNC_PARAM, (unsigned long)data);
+// printk("test 123 end\n");
+ break;
+ }
+ case COMPAT_ISP_IO_LNC:
+ {
+ struct compat_isp_reg_param __user *data32;
+ struct isp_reg_param __user *data;
+ uint32_t cnt;
+
+
+ data32 = compat_ptr(param);
+ err = get_user(cnt, &data32->counts);
+
+// printk("COMPAT_ISP_IO_WRITE param: %p \n", data32);
+ data = compat_alloc_user_space(sizeof(struct isp_reg_param)+cnt*sizeof(struct isp_reg_bits));
+ if (data == NULL) {
+ printk("compat_isp_k failed to compat_alloc_user_space \n");
+ return -EFAULT;
+ }
+// printk("@@1 %p", data);
+ err = compat_get_rw_param(data32, data);
+ if (err) {
+ return err;
+ }
+ err = compat_get_rw_param_detail(data);
+ if (err) {
+ printk("compat_isp_k error %d\n", err);
+ return err;
+ }
+ // printk("test ISP_IO_LNC\n");
+ err = fl->f_op->unlocked_ioctl(fl, ISP_IO_LNC, (unsigned long)data);
+ // printk("test ISP_IO_LNC end\n");
+ break;
+ }
+ case COMPAT_ISP_IO_ALLOC:
+ {
+ struct compat_isp_reg_param __user *data32;
+ struct isp_reg_param __user *data;
+
+ data32 = compat_ptr(param);
+ data = compat_alloc_user_space(sizeof(*data));
+ if (data == NULL) {
+ printk("compat_isp_k failed to compat_alloc_user_space \n");
+ return -EFAULT;
+ }
+ err = compat_get_alloc_param(data32, data);
+ if (err) {
+ return err;
+ }
+ ret = fl->f_op->unlocked_ioctl(fl, ISP_IO_ALLOC, (unsigned long)data);
+ if (ret) {
+ printk("compat_isp_k,failed to ISP_IO_ALLOC %ld", ret);
+ goto exit;
+ }
+ err = compat_put_alloc(data32, data);
+ ret = err;
+ break;
+ }
+
+ case ISP_IO_RST:
+ case ISP_IO_SETCLK:
+ case ISP_IO_STOP:
+ case ISP_IO_INT:
+ case ISP_IO_DCAM_INT:
+ {
+ ret = fl->f_op->unlocked_ioctl(fl, cmd, (unsigned long)up);
+ break;
+ }
+ default:
+ printk("compat_isp_k, don't support cmd 0x%x", cmd);
+ break;
+ }
+ }
+exit:
+ return ret;
+}
generated by cgit v1.3.1 (git 2.54.0) at 2026-08-15 17:23:37 +0000