summaryrefslogtreecommitdiff
path: root/drivers/media/sprd_isp/isp2.0/pike/src/isp_k_binning4awb.c
diff options
context:
space:
mode:
authorYuval Adam <_@yuv.al>2017-08-30 08:25:59 +0000
committerYuval Adam <_@yuv.al>2017-08-30 08:25:59 +0000
commit8e4bff4cab0ddac6060645b0715210484d02ff40 (patch)
tree3a5c3024371a04692a3a6d9974d001cdff8ebf84 /drivers/media/sprd_isp/isp2.0/pike/src/isp_k_binning4awb.c
Initial file dump from open source releaseHEADmaster
Diffstat (limited to 'drivers/media/sprd_isp/isp2.0/pike/src/isp_k_binning4awb.c')
-rw-r--r--drivers/media/sprd_isp/isp2.0/pike/src/isp_k_binning4awb.c231
1 files changed, 231 insertions, 0 deletions
diff --git a/drivers/media/sprd_isp/isp2.0/pike/src/isp_k_binning4awb.c b/drivers/media/sprd_isp/isp2.0/pike/src/isp_k_binning4awb.c
new file mode 100644
index 00000000..86778075
--- /dev/null
+++ b/drivers/media/sprd_isp/isp2.0/pike/src/isp_k_binning4awb.c
@@ -0,0 +1,231 @@
+/*
+ * 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/uaccess.h>
+#include <linux/sprd_mm.h>
+#include <video/sprd_isp.h>
+#include <asm/cacheflush.h>
+#include "isp_reg.h"
+#include "isp_drv.h"
+
+static int32_t isp_k_binging_param_update(struct isp_k_private *isp_private)
+{
+ int32_t ret = 0;
+
+ /*config buf_id 0 as default*/
+ isp_private->b4awb_buf[0].buf_flag = 1;
+ REG_WR(ISP_BINNING_MEM_ADDR, isp_private->b4awb_buf[0].buf_phys_addr);
+
+ return ret;
+}
+
+static int32_t isp_k_binning_block(struct isp_io_param *param,
+ struct isp_k_private *isp_private)
+{
+ int32_t ret = 0;
+ uint32_t val = 0;
+ struct isp_dev_binning4awb_info_v1 binning_info;
+
+ ret = copy_from_user((void *)&binning_info, param->property_param, sizeof(binning_info));
+ if (0 != ret) {
+ printk("isp_k_binning_block: copy error, ret=0x%x\n", (uint32_t)ret);
+ return -1;
+ }
+
+ if (isp_private->b4awb_buf[0].buf_phys_addr == 0 || isp_private->b4awb_buf[1].buf_phys_addr == 0) {
+ REG_MWR(ISP_BINNING_PARAM, BIT_0, 0x1);
+ return ret;
+ }
+
+ isp_k_binging_param_update(isp_private);
+
+ val = (binning_info.burst_mode & 0x3) << 2;
+ REG_MWR(ISP_BINNING_PARAM, 0xC, val);
+
+ val = (binning_info.endian & 0x1) << 1;
+ REG_MWR(ISP_BINNING_PARAM, BIT_1, val);
+
+ val = (binning_info.mem_fifo_clr & 0x1) << 7;
+ REG_MWR(ISP_BINNING_PARAM, 0x80, val);
+
+ val = ((binning_info.hx & 0x7) << 4) | ((binning_info.vx & 0x7) << 8);
+ REG_MWR(ISP_BINNING_PARAM, 0x770, val);
+
+ REG_WR(ISP_BINNING_PITCH, binning_info.pitch);
+
+ REG_MWR(ISP_BINNING_PARAM, BIT_0, binning_info.bypass);
+
+ return ret;
+
+}
+
+static int32_t isp_k_binging_bypass(struct isp_io_param *param)
+{
+ int32_t ret = 0;
+ uint32_t bypass = 0;
+ ret = copy_from_user((void *)&bypass, param->property_param, sizeof(uint32_t));
+ if (0 != ret) {
+ printk("isp_k_binning_scaling_ratio: copy_from_user error, ret = 0x%x\n",(uint32_t)ret);
+ return -1;
+ }
+
+ REG_MWR(ISP_BINNING_PARAM, BIT_0, bypass);
+
+ return ret;
+}
+
+static int32_t isp_k_binning_scaling_ratio(struct isp_io_param *param)
+{
+ int32_t ret = 0;
+ uint32_t val = 0;
+ struct isp_scaling_ratio scaling_ratio;
+ ret = copy_from_user((void *)&scaling_ratio, param->property_param, sizeof(struct isp_scaling_ratio));
+ if (0 != ret) {
+ printk("isp_k_binning_scaling_ratio: copy_from_user error, ret = 0x%x\n",(uint32_t)ret);
+ return -1;
+ }
+
+ val = ((scaling_ratio.vertical & 0x7)<< 8)| ((scaling_ratio.horizontal & 0x7) << 4);
+ REG_MWR(ISP_BINNING_PARAM, 0x770, val);
+
+ return ret;
+}
+
+static int32_t isp_k_binning_get_scaling_ratio(struct isp_io_param *param)
+{
+ int32_t ret = 0;
+ uint32_t val = 0;
+ struct isp_scaling_ratio scaling_ratio;
+
+ val = REG_RD(ISP_BINNING_PARAM);
+
+ scaling_ratio.vertical= (val >> 8) & 0x7;
+ scaling_ratio.horizontal = (val >> 4) & 0x7;
+
+ ret = copy_to_user(param->property_param, (void *)&scaling_ratio, sizeof(struct isp_scaling_ratio));
+ if (0 != ret) {
+ ret = -1;
+ printk("isp_k_binning_get_scaling_ratio: copy error, ret=0x%x\n", (uint32_t)ret);
+ }
+
+ return ret;
+}
+
+static int32_t isp_k_binging_mem_addr(struct isp_io_param *param)
+{
+ int32_t ret = 0;
+ uint32_t addr = 0;
+
+ ret = copy_from_user((void *)&addr, param->property_param, sizeof(uint32_t));
+ if (0 != ret) {
+ printk("isp_k_binning_scaling_ratio: copy_from_user error, ret = 0x%x\n",(uint32_t)ret);
+ return -1;
+ }
+
+ REG_WR(ISP_BINNING_MEM_ADDR, addr);
+
+ return ret;
+}
+
+static int32_t isp_k_binning_statistics_buf(struct isp_io_param *param,
+ struct isp_k_private *isp_private)
+{
+ int32_t ret = 0;
+ uint32_t buf_id = 0;
+
+ if (isp_private->b4awb_buf[0].buf_flag == 0) {
+ buf_id = isp_private->b4awb_buf[0].buf_id;
+ } else if (isp_private->b4awb_buf[1].buf_flag == 0) {
+ buf_id = isp_private->b4awb_buf[0].buf_id;
+ }
+
+ ret = copy_to_user(param->property_param, (void*)&buf_id, sizeof(uint32_t));
+ if (0 != ret) {
+ ret = -1;
+ printk("isp_k_binning_statistics_buf: copy error, ret=0x%x\n", (uint32_t)ret);
+ }
+
+ return ret;
+}
+
+static int32_t isp_k_binning_buffaddr(struct isp_io_param *param,
+ struct isp_k_private *isp_private)
+{
+ int32_t ret = 0;
+ int32_t i = 0;
+ unsigned long phys_addr[2];
+ struct isp_b4awb_phys phy_addr;
+
+ ret = copy_from_user((void *)&phy_addr, param->property_param, sizeof(struct isp_b4awb_phys));
+ if (0 != ret) {
+ ret = -1;
+ printk("isp_k_binning_buffaddr: copy error, ret=0x%x\n", (uint32_t)ret);
+ }
+
+ phys_addr[0] = phy_addr.phys0;
+ phys_addr[1] = phy_addr.phys1;
+
+ for (i = 0; i < ISP_BING4AWB_NUM; i++) {
+ isp_private->b4awb_buf[i].buf_id = i;
+ isp_private->b4awb_buf[i].buf_flag = 0;
+ isp_private->b4awb_buf[i].buf_phys_addr = phys_addr[i];
+ }
+
+ printk("phys_addr 0x%lx, 0x%lx\n",phys_addr[0], phys_addr[1]);
+
+ return ret;
+}
+
+int32_t isp_k_cfg_binning(struct isp_io_param *param, struct isp_k_private *isp_private)
+{
+ int32_t ret = 0;
+
+ if (!param) {
+ printk("isp_k_cfg_binning: param is null error.\n");
+ return -1;
+ }
+
+ if (NULL == param->property_param) {
+ printk("isp_k_cfg_binning: property_param is null error.\n");
+ return -1;
+ }
+
+ switch(param->property) {
+ case ISP_PRO_BINNING4AWB_BLOCK:
+ ret = isp_k_binning_block(param, isp_private);
+ break;
+ case ISP_PRO_BINNING4AWB_BYPASS:
+ ret = isp_k_binging_bypass(param);
+ break;
+ case ISP_PRO_BINNING4AWB_SCALING_RATIO:
+ ret = isp_k_binning_scaling_ratio(param);
+ break;
+ case ISP_PRO_BINNING4AWB_GET_SCALING_RATIO:
+ ret = isp_k_binning_get_scaling_ratio(param);
+ break;
+ case ISP_PRO_BINNING4AWB_MEM_ADDR:
+ ret = isp_k_binging_mem_addr(param);
+ break;
+ case ISP_PRO_BINNING4AWB_STATISTICS_BUF:
+ ret = isp_k_binning_statistics_buf(param, isp_private);
+ break;
+ case ISP_PRO_BINNING4AWB_TRANSADDR:
+ ret = isp_k_binning_buffaddr(param, isp_private);
+ break;
+ default:
+ printk("isp_k_cfg_binning: fail cmd id:%d, not supported.\n", param->property);
+ break;
+ }
+
+ return ret;
+}