diff options
Diffstat (limited to 'drivers/media/sprd_isp/isp2.0/tshark2/src/isp_k_iircnr.c')
| -rw-r--r-- | drivers/media/sprd_isp/isp2.0/tshark2/src/isp_k_iircnr.c | 133 |
1 files changed, 133 insertions, 0 deletions
diff --git a/drivers/media/sprd_isp/isp2.0/tshark2/src/isp_k_iircnr.c b/drivers/media/sprd_isp/isp2.0/tshark2/src/isp_k_iircnr.c new file mode 100644 index 00000000..6c6e0591 --- /dev/null +++ b/drivers/media/sprd_isp/isp2.0/tshark2/src/isp_k_iircnr.c @@ -0,0 +1,133 @@ +/* + * 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 "isp_reg.h" + +static int32_t isp_k_iircnr_block(struct isp_io_param *param) +{ + int32_t ret = 0; + struct isp_dev_iircnr_info_v1 iircnr_info; + uint32_t val = 0; + + memset(&iircnr_info, 0x00, sizeof(iircnr_info)); + + ret = copy_from_user((void *)&iircnr_info, param->property_param, sizeof(iircnr_info)); + if (0 != ret) { + printk("isp_k_iircnr_block: copy_from_user error, ret = 0x%x\n", (uint32_t)ret); + return -1; + } + + if (iircnr_info.mode) { + REG_OWR(ISP_IIRCNR_PARAM1, BIT_0); + } else { + REG_MWR(ISP_IIRCNR_PARAM1, BIT_0, 0); + } + + val = ((iircnr_info.y_th & 0xFF) << 12) | ((iircnr_info.uv_th & 0x7FF) << 1); + REG_MWR(ISP_IIRCNR_PARAM1, 0xFFFFE, val); + + val = ((iircnr_info.uv_pg_th & 0x3FFF) << 10) | (iircnr_info.uv_dist & 0x3FF); + REG_WR(ISP_IIRCNR_PARAM2, val); + + val = ((iircnr_info.uv_low_thr2 & 0x1FFFF) << 14) | (iircnr_info.uv_low_thr1 & 0x3FFF); + REG_WR(ISP_IIRCNR_PARAM3, val); + + val = iircnr_info.uv_s_th & 0xFF; + REG_MWR(ISP_IIRCNR_PARAM6, 0xFF, val); + + val = (iircnr_info.alpha_low_v & 0x3FFF) | ((iircnr_info.alpha_low_u & 0x3FFF) << 14); + REG_WR(ISP_IIRCNR_PARAM7, val); + + val = iircnr_info.uv_high_thr2 & 0x1FFFF; + REG_WR(ISP_IIRCNR_PARAM9, val); + + val = iircnr_info.ymd_u & 0x3FFFFFFF; + REG_WR(ISP_IIRCNR_PARAM4, val); + + val = iircnr_info.ymd_v & 0x3FFFFFFF; + REG_WR(ISP_IIRCNR_PARAM5, val); + + REG_MWR(ISP_IIRCNR_PARAM6, 0xFF00, iircnr_info.slope << 8); + REG_WR(ISP_IIRCNR_PARAM8, iircnr_info.factor & 0x1FFFFFF); + + + if (iircnr_info.bypass) { + REG_OWR(ISP_IIRCNR_PARAM, BIT_0); + } else { + REG_MWR(ISP_IIRCNR_PARAM, BIT_0, 0); + } + + return ret; +} + +static int32_t isp_k_yrandom_block(struct isp_io_param *param) +{ + int32_t ret = 0; + struct isp_dev_yrandom_info_v1 yrandom_info; + uint32_t val = 0; + + memset(&yrandom_info, 0x00, sizeof(yrandom_info)); + + ret = copy_from_user((void *)&yrandom_info, param->property_param, sizeof(yrandom_info)); + if (0 != ret) { + printk("isp_k_yrandom_block: copy_from_user error, ret = 0x%x\n", (uint32_t)ret); + return -1; + } + + REG_MWR(ISP_YRANDOM_PARAM0, 0xFFFFFF00, yrandom_info.seed << 8); + REG_MWR(ISP_YRANDOM_PARAM0, BIT_2, yrandom_info.mode << 2); + REG_MWR(ISP_YRANDOM_PARAM0, BIT_0, yrandom_info.init); + REG_MWR(ISP_YRANDOM_PARAM1, 0x7FF0000, yrandom_info.offset << 16); + REG_MWR(ISP_YRANDOM_PARAM1, 0xF, yrandom_info.shift); + + val = (yrandom_info.takeBit[0] & 0xF) | ((yrandom_info.takeBit[1] & 0xF) << 4) + | ((yrandom_info.takeBit[2] & 0xF) << 8) | ((yrandom_info.takeBit[3] & 0xF) << 12) + | ((yrandom_info.takeBit[4] & 0xF) << 16) | ((yrandom_info.takeBit[5] & 0xF) << 20) + | ((yrandom_info.takeBit[6] & 0xF) << 24) | ((yrandom_info.takeBit[7] & 0xF) << 28); + REG_WR(ISP_YRANDOM_PARAM2, val); + + REG_MWR(ISP_YRANDOM_PARAM0, BIT_0, yrandom_info.bypass); + + return ret; +} + +int32_t isp_k_cfg_iircnr(struct isp_io_param *param) +{ + int32_t ret = 0; + + if (!param) { + printk("isp_k_cfg_iircnr: param is null error.\n"); + return -1; + } + + if (NULL == param->property_param) { + printk("isp_k_cfg_iircnr: property_param is null error.\n"); + return -1; + } + + switch(param->property) { + case ISP_PRO_IIRCNR_BLOCK: + ret = isp_k_iircnr_block(param); + break; + case ISP_PRO_YRANDOM_BLOCK: + ret = isp_k_yrandom_block(param); + break; + default: + printk("isp_k_cfg_iircnr: fail cmd id:%d, not supported.\n", param->property); + break; + } + + return ret; +} |