// SPDX-License-Identifier: GPL-2.0-only 
 | 
/* 
 | 
 * Samsung EXYNOS4x12 FIMC-IS (Imaging Subsystem) driver 
 | 
 * 
 | 
 * Copyright (C) 2013 Samsung Electronics Co., Ltd. 
 | 
 * 
 | 
 * Authors: Younghwan Joo <yhwan.joo@samsung.com> 
 | 
 *          Sylwester Nawrocki <s.nawrocki@samsung.com> 
 | 
 */ 
 | 
#define pr_fmt(fmt) "%s:%d " fmt, __func__, __LINE__ 
 | 
  
 | 
#include <linux/bitops.h> 
 | 
#include <linux/bug.h> 
 | 
#include <linux/device.h> 
 | 
#include <linux/errno.h> 
 | 
#include <linux/kernel.h> 
 | 
#include <linux/module.h> 
 | 
#include <linux/platform_device.h> 
 | 
#include <linux/slab.h> 
 | 
#include <linux/types.h> 
 | 
#include <linux/videodev2.h> 
 | 
  
 | 
#include <media/v4l2-device.h> 
 | 
#include <media/v4l2-ioctl.h> 
 | 
  
 | 
#include "fimc-is.h" 
 | 
#include "fimc-is-command.h" 
 | 
#include "fimc-is-errno.h" 
 | 
#include "fimc-is-param.h" 
 | 
#include "fimc-is-regs.h" 
 | 
#include "fimc-is-sensor.h" 
 | 
  
 | 
static void __hw_param_copy(void *dst, void *src) 
 | 
{ 
 | 
    memcpy(dst, src, FIMC_IS_PARAM_MAX_SIZE); 
 | 
} 
 | 
  
 | 
static void __fimc_is_hw_update_param_global_shotmode(struct fimc_is *is) 
 | 
{ 
 | 
    struct param_global_shotmode *dst, *src; 
 | 
  
 | 
    dst = &is->is_p_region->parameter.global.shotmode; 
 | 
    src = &is->config[is->config_index].global.shotmode; 
 | 
    __hw_param_copy(dst, src); 
 | 
} 
 | 
  
 | 
static void __fimc_is_hw_update_param_sensor_framerate(struct fimc_is *is) 
 | 
{ 
 | 
    struct param_sensor_framerate *dst, *src; 
 | 
  
 | 
    dst = &is->is_p_region->parameter.sensor.frame_rate; 
 | 
    src = &is->config[is->config_index].sensor.frame_rate; 
 | 
    __hw_param_copy(dst, src); 
 | 
} 
 | 
  
 | 
int __fimc_is_hw_update_param(struct fimc_is *is, u32 offset) 
 | 
{ 
 | 
    struct is_param_region *par = &is->is_p_region->parameter; 
 | 
    struct chain_config *cfg = &is->config[is->config_index]; 
 | 
  
 | 
    switch (offset) { 
 | 
    case PARAM_ISP_CONTROL: 
 | 
        __hw_param_copy(&par->isp.control, &cfg->isp.control); 
 | 
        break; 
 | 
  
 | 
    case PARAM_ISP_OTF_INPUT: 
 | 
        __hw_param_copy(&par->isp.otf_input, &cfg->isp.otf_input); 
 | 
        break; 
 | 
  
 | 
    case PARAM_ISP_DMA1_INPUT: 
 | 
        __hw_param_copy(&par->isp.dma1_input, &cfg->isp.dma1_input); 
 | 
        break; 
 | 
  
 | 
    case PARAM_ISP_DMA2_INPUT: 
 | 
        __hw_param_copy(&par->isp.dma2_input, &cfg->isp.dma2_input); 
 | 
        break; 
 | 
  
 | 
    case PARAM_ISP_AA: 
 | 
        __hw_param_copy(&par->isp.aa, &cfg->isp.aa); 
 | 
        break; 
 | 
  
 | 
    case PARAM_ISP_FLASH: 
 | 
        __hw_param_copy(&par->isp.flash, &cfg->isp.flash); 
 | 
        break; 
 | 
  
 | 
    case PARAM_ISP_AWB: 
 | 
        __hw_param_copy(&par->isp.awb, &cfg->isp.awb); 
 | 
        break; 
 | 
  
 | 
    case PARAM_ISP_IMAGE_EFFECT: 
 | 
        __hw_param_copy(&par->isp.effect, &cfg->isp.effect); 
 | 
        break; 
 | 
  
 | 
    case PARAM_ISP_ISO: 
 | 
        __hw_param_copy(&par->isp.iso, &cfg->isp.iso); 
 | 
        break; 
 | 
  
 | 
    case PARAM_ISP_ADJUST: 
 | 
        __hw_param_copy(&par->isp.adjust, &cfg->isp.adjust); 
 | 
        break; 
 | 
  
 | 
    case PARAM_ISP_METERING: 
 | 
        __hw_param_copy(&par->isp.metering, &cfg->isp.metering); 
 | 
        break; 
 | 
  
 | 
    case PARAM_ISP_AFC: 
 | 
        __hw_param_copy(&par->isp.afc, &cfg->isp.afc); 
 | 
        break; 
 | 
  
 | 
    case PARAM_ISP_OTF_OUTPUT: 
 | 
        __hw_param_copy(&par->isp.otf_output, &cfg->isp.otf_output); 
 | 
        break; 
 | 
  
 | 
    case PARAM_ISP_DMA1_OUTPUT: 
 | 
        __hw_param_copy(&par->isp.dma1_output, &cfg->isp.dma1_output); 
 | 
        break; 
 | 
  
 | 
    case PARAM_ISP_DMA2_OUTPUT: 
 | 
        __hw_param_copy(&par->isp.dma2_output, &cfg->isp.dma2_output); 
 | 
        break; 
 | 
  
 | 
    case PARAM_DRC_CONTROL: 
 | 
        __hw_param_copy(&par->drc.control, &cfg->drc.control); 
 | 
        break; 
 | 
  
 | 
    case PARAM_DRC_OTF_INPUT: 
 | 
        __hw_param_copy(&par->drc.otf_input, &cfg->drc.otf_input); 
 | 
        break; 
 | 
  
 | 
    case PARAM_DRC_DMA_INPUT: 
 | 
        __hw_param_copy(&par->drc.dma_input, &cfg->drc.dma_input); 
 | 
        break; 
 | 
  
 | 
    case PARAM_DRC_OTF_OUTPUT: 
 | 
        __hw_param_copy(&par->drc.otf_output, &cfg->drc.otf_output); 
 | 
        break; 
 | 
  
 | 
    case PARAM_FD_CONTROL: 
 | 
        __hw_param_copy(&par->fd.control, &cfg->fd.control); 
 | 
        break; 
 | 
  
 | 
    case PARAM_FD_OTF_INPUT: 
 | 
        __hw_param_copy(&par->fd.otf_input, &cfg->fd.otf_input); 
 | 
        break; 
 | 
  
 | 
    case PARAM_FD_DMA_INPUT: 
 | 
        __hw_param_copy(&par->fd.dma_input, &cfg->fd.dma_input); 
 | 
        break; 
 | 
  
 | 
    case PARAM_FD_CONFIG: 
 | 
        __hw_param_copy(&par->fd.config, &cfg->fd.config); 
 | 
        break; 
 | 
  
 | 
    default: 
 | 
        return -EINVAL; 
 | 
    } 
 | 
  
 | 
    return 0; 
 | 
} 
 | 
  
 | 
unsigned int __get_pending_param_count(struct fimc_is *is) 
 | 
{ 
 | 
    struct chain_config *config = &is->config[is->config_index]; 
 | 
    unsigned long flags; 
 | 
    unsigned int count; 
 | 
  
 | 
    spin_lock_irqsave(&is->slock, flags); 
 | 
    count = hweight32(config->p_region_index[0]); 
 | 
    count += hweight32(config->p_region_index[1]); 
 | 
    spin_unlock_irqrestore(&is->slock, flags); 
 | 
  
 | 
    return count; 
 | 
} 
 | 
  
 | 
int __is_hw_update_params(struct fimc_is *is) 
 | 
{ 
 | 
    unsigned long *p_index; 
 | 
    int i, id, ret = 0; 
 | 
  
 | 
    id = is->config_index; 
 | 
    p_index = &is->config[id].p_region_index[0]; 
 | 
  
 | 
    if (test_bit(PARAM_GLOBAL_SHOTMODE, p_index)) 
 | 
        __fimc_is_hw_update_param_global_shotmode(is); 
 | 
  
 | 
    if (test_bit(PARAM_SENSOR_FRAME_RATE, p_index)) 
 | 
        __fimc_is_hw_update_param_sensor_framerate(is); 
 | 
  
 | 
    for (i = PARAM_ISP_CONTROL; i < PARAM_DRC_CONTROL; i++) { 
 | 
        if (test_bit(i, p_index)) 
 | 
            ret = __fimc_is_hw_update_param(is, i); 
 | 
    } 
 | 
  
 | 
    for (i = PARAM_DRC_CONTROL; i < PARAM_SCALERC_CONTROL; i++) { 
 | 
        if (test_bit(i, p_index)) 
 | 
            ret = __fimc_is_hw_update_param(is, i); 
 | 
    } 
 | 
  
 | 
    for (i = PARAM_FD_CONTROL; i <= PARAM_FD_CONFIG; i++) { 
 | 
        if (test_bit(i, p_index)) 
 | 
            ret = __fimc_is_hw_update_param(is, i); 
 | 
    } 
 | 
  
 | 
    return ret; 
 | 
} 
 | 
  
 | 
void __is_get_frame_size(struct fimc_is *is, struct v4l2_mbus_framefmt *mf) 
 | 
{ 
 | 
    struct isp_param *isp; 
 | 
  
 | 
    isp = &is->config[is->config_index].isp; 
 | 
    mf->width = isp->otf_input.width; 
 | 
    mf->height = isp->otf_input.height; 
 | 
} 
 | 
  
 | 
void __is_set_frame_size(struct fimc_is *is, struct v4l2_mbus_framefmt *mf) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct isp_param *isp; 
 | 
    struct drc_param *drc; 
 | 
    struct fd_param *fd; 
 | 
  
 | 
    isp = &is->config[index].isp; 
 | 
    drc = &is->config[index].drc; 
 | 
    fd = &is->config[index].fd; 
 | 
  
 | 
    /* Update isp size info (OTF only) */ 
 | 
    isp->otf_input.width = mf->width; 
 | 
    isp->otf_input.height = mf->height; 
 | 
    isp->otf_output.width = mf->width; 
 | 
    isp->otf_output.height = mf->height; 
 | 
    /* Update drc size info (OTF only) */ 
 | 
    drc->otf_input.width = mf->width; 
 | 
    drc->otf_input.height = mf->height; 
 | 
    drc->otf_output.width = mf->width; 
 | 
    drc->otf_output.height = mf->height; 
 | 
    /* Update fd size info (OTF only) */ 
 | 
    fd->otf_input.width = mf->width; 
 | 
    fd->otf_input.height = mf->height; 
 | 
  
 | 
    if (test_bit(PARAM_ISP_OTF_INPUT, 
 | 
              &is->config[index].p_region_index[0])) 
 | 
        return; 
 | 
  
 | 
    /* Update field */ 
 | 
    fimc_is_set_param_bit(is, PARAM_ISP_OTF_INPUT); 
 | 
    fimc_is_set_param_bit(is, PARAM_ISP_OTF_OUTPUT); 
 | 
    fimc_is_set_param_bit(is, PARAM_DRC_OTF_INPUT); 
 | 
    fimc_is_set_param_bit(is, PARAM_DRC_OTF_OUTPUT); 
 | 
    fimc_is_set_param_bit(is, PARAM_FD_OTF_INPUT); 
 | 
} 
 | 
  
 | 
int fimc_is_hw_get_sensor_max_framerate(struct fimc_is *is) 
 | 
{ 
 | 
    switch (is->sensor->drvdata->id) { 
 | 
    case FIMC_IS_SENSOR_ID_S5K6A3: 
 | 
        return 30; 
 | 
    default: 
 | 
        return 15; 
 | 
    } 
 | 
} 
 | 
  
 | 
void __is_set_sensor(struct fimc_is *is, int fps) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct sensor_param *sensor; 
 | 
    struct isp_param *isp; 
 | 
  
 | 
    sensor = &is->config[index].sensor; 
 | 
    isp = &is->config[index].isp; 
 | 
  
 | 
    if (fps == 0) { 
 | 
        sensor->frame_rate.frame_rate = 
 | 
                fimc_is_hw_get_sensor_max_framerate(is); 
 | 
        isp->otf_input.frametime_min = 0; 
 | 
        isp->otf_input.frametime_max = 66666; 
 | 
    } else { 
 | 
        sensor->frame_rate.frame_rate = fps; 
 | 
        isp->otf_input.frametime_min = 0; 
 | 
        isp->otf_input.frametime_max = (u32)1000000 / fps; 
 | 
    } 
 | 
  
 | 
    fimc_is_set_param_bit(is, PARAM_SENSOR_FRAME_RATE); 
 | 
    fimc_is_set_param_bit(is, PARAM_ISP_OTF_INPUT); 
 | 
} 
 | 
  
 | 
static void __maybe_unused __is_set_init_isp_aa(struct fimc_is *is) 
 | 
{ 
 | 
    struct isp_param *isp; 
 | 
  
 | 
    isp = &is->config[is->config_index].isp; 
 | 
  
 | 
    isp->aa.cmd = ISP_AA_COMMAND_START; 
 | 
    isp->aa.target = ISP_AA_TARGET_AF | ISP_AA_TARGET_AE | 
 | 
             ISP_AA_TARGET_AWB; 
 | 
    isp->aa.mode = 0; 
 | 
    isp->aa.scene = 0; 
 | 
    isp->aa.sleep = 0; 
 | 
    isp->aa.face = 0; 
 | 
    isp->aa.touch_x = 0; 
 | 
    isp->aa.touch_y = 0; 
 | 
    isp->aa.manual_af_setting = 0; 
 | 
    isp->aa.err = ISP_AF_ERROR_NONE; 
 | 
  
 | 
    fimc_is_set_param_bit(is, PARAM_ISP_AA); 
 | 
} 
 | 
  
 | 
void __is_set_isp_flash(struct fimc_is *is, u32 cmd, u32 redeye) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct isp_param *isp = &is->config[index].isp; 
 | 
  
 | 
    isp->flash.cmd = cmd; 
 | 
    isp->flash.redeye = redeye; 
 | 
    isp->flash.err = ISP_FLASH_ERROR_NONE; 
 | 
  
 | 
    fimc_is_set_param_bit(is, PARAM_ISP_FLASH); 
 | 
} 
 | 
  
 | 
void __is_set_isp_awb(struct fimc_is *is, u32 cmd, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct isp_param *isp; 
 | 
  
 | 
    isp = &is->config[index].isp; 
 | 
  
 | 
    isp->awb.cmd = cmd; 
 | 
    isp->awb.illumination = val; 
 | 
    isp->awb.err = ISP_AWB_ERROR_NONE; 
 | 
  
 | 
    fimc_is_set_param_bit(is, PARAM_ISP_AWB); 
 | 
} 
 | 
  
 | 
void __is_set_isp_effect(struct fimc_is *is, u32 cmd) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct isp_param *isp; 
 | 
  
 | 
    isp = &is->config[index].isp; 
 | 
  
 | 
    isp->effect.cmd = cmd; 
 | 
    isp->effect.err = ISP_IMAGE_EFFECT_ERROR_NONE; 
 | 
  
 | 
    fimc_is_set_param_bit(is, PARAM_ISP_IMAGE_EFFECT); 
 | 
} 
 | 
  
 | 
void __is_set_isp_iso(struct fimc_is *is, u32 cmd, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct isp_param *isp; 
 | 
  
 | 
    isp = &is->config[index].isp; 
 | 
  
 | 
    isp->iso.cmd = cmd; 
 | 
    isp->iso.value = val; 
 | 
    isp->iso.err = ISP_ISO_ERROR_NONE; 
 | 
  
 | 
    fimc_is_set_param_bit(is, PARAM_ISP_ISO); 
 | 
} 
 | 
  
 | 
void __is_set_isp_adjust(struct fimc_is *is, u32 cmd, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    unsigned long *p_index; 
 | 
    struct isp_param *isp; 
 | 
  
 | 
    p_index = &is->config[index].p_region_index[0]; 
 | 
    isp = &is->config[index].isp; 
 | 
  
 | 
    switch (cmd) { 
 | 
    case ISP_ADJUST_COMMAND_MANUAL_CONTRAST: 
 | 
        isp->adjust.contrast = val; 
 | 
        break; 
 | 
    case ISP_ADJUST_COMMAND_MANUAL_SATURATION: 
 | 
        isp->adjust.saturation = val; 
 | 
        break; 
 | 
    case ISP_ADJUST_COMMAND_MANUAL_SHARPNESS: 
 | 
        isp->adjust.sharpness = val; 
 | 
        break; 
 | 
    case ISP_ADJUST_COMMAND_MANUAL_EXPOSURE: 
 | 
        isp->adjust.exposure = val; 
 | 
        break; 
 | 
    case ISP_ADJUST_COMMAND_MANUAL_BRIGHTNESS: 
 | 
        isp->adjust.brightness = val; 
 | 
        break; 
 | 
    case ISP_ADJUST_COMMAND_MANUAL_HUE: 
 | 
        isp->adjust.hue = val; 
 | 
        break; 
 | 
    case ISP_ADJUST_COMMAND_AUTO: 
 | 
        isp->adjust.contrast = 0; 
 | 
        isp->adjust.saturation = 0; 
 | 
        isp->adjust.sharpness = 0; 
 | 
        isp->adjust.exposure = 0; 
 | 
        isp->adjust.brightness = 0; 
 | 
        isp->adjust.hue = 0; 
 | 
        break; 
 | 
    } 
 | 
  
 | 
    if (!test_bit(PARAM_ISP_ADJUST, p_index)) { 
 | 
        isp->adjust.cmd = cmd; 
 | 
        isp->adjust.err = ISP_ADJUST_ERROR_NONE; 
 | 
        fimc_is_set_param_bit(is, PARAM_ISP_ADJUST); 
 | 
    } else { 
 | 
        isp->adjust.cmd |= cmd; 
 | 
    } 
 | 
} 
 | 
  
 | 
void __is_set_isp_metering(struct fimc_is *is, u32 id, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct isp_param *isp; 
 | 
    unsigned long *p_index; 
 | 
  
 | 
    p_index = &is->config[index].p_region_index[0]; 
 | 
    isp = &is->config[index].isp; 
 | 
  
 | 
    switch (id) { 
 | 
    case IS_METERING_CONFIG_CMD: 
 | 
        isp->metering.cmd = val; 
 | 
        break; 
 | 
    case IS_METERING_CONFIG_WIN_POS_X: 
 | 
        isp->metering.win_pos_x = val; 
 | 
        break; 
 | 
    case IS_METERING_CONFIG_WIN_POS_Y: 
 | 
        isp->metering.win_pos_y = val; 
 | 
        break; 
 | 
    case IS_METERING_CONFIG_WIN_WIDTH: 
 | 
        isp->metering.win_width = val; 
 | 
        break; 
 | 
    case IS_METERING_CONFIG_WIN_HEIGHT: 
 | 
        isp->metering.win_height = val; 
 | 
        break; 
 | 
    default: 
 | 
        return; 
 | 
    } 
 | 
  
 | 
    if (!test_bit(PARAM_ISP_METERING, p_index)) { 
 | 
        isp->metering.err = ISP_METERING_ERROR_NONE; 
 | 
        fimc_is_set_param_bit(is, PARAM_ISP_METERING); 
 | 
    } 
 | 
} 
 | 
  
 | 
void __is_set_isp_afc(struct fimc_is *is, u32 cmd, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct isp_param *isp; 
 | 
  
 | 
    isp = &is->config[index].isp; 
 | 
  
 | 
    isp->afc.cmd = cmd; 
 | 
    isp->afc.manual = val; 
 | 
    isp->afc.err = ISP_AFC_ERROR_NONE; 
 | 
  
 | 
    fimc_is_set_param_bit(is, PARAM_ISP_AFC); 
 | 
} 
 | 
  
 | 
void __is_set_drc_control(struct fimc_is *is, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct drc_param *drc; 
 | 
  
 | 
    drc = &is->config[index].drc; 
 | 
  
 | 
    drc->control.bypass = val; 
 | 
  
 | 
    fimc_is_set_param_bit(is, PARAM_DRC_CONTROL); 
 | 
} 
 | 
  
 | 
void __is_set_fd_control(struct fimc_is *is, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct fd_param *fd; 
 | 
    unsigned long *p_index; 
 | 
  
 | 
    p_index = &is->config[index].p_region_index[1]; 
 | 
    fd = &is->config[index].fd; 
 | 
  
 | 
    fd->control.cmd = val; 
 | 
  
 | 
    if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) 
 | 
        fimc_is_set_param_bit(is, PARAM_FD_CONTROL); 
 | 
} 
 | 
  
 | 
void __is_set_fd_config_maxface(struct fimc_is *is, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct fd_param *fd; 
 | 
    unsigned long *p_index; 
 | 
  
 | 
    p_index = &is->config[index].p_region_index[1]; 
 | 
    fd = &is->config[index].fd; 
 | 
  
 | 
    fd->config.max_number = val; 
 | 
  
 | 
    if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 
 | 
        fd->config.cmd = FD_CONFIG_COMMAND_MAXIMUM_NUMBER; 
 | 
        fd->config.err = ERROR_FD_NONE; 
 | 
        fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 
 | 
    } else { 
 | 
        fd->config.cmd |= FD_CONFIG_COMMAND_MAXIMUM_NUMBER; 
 | 
    } 
 | 
} 
 | 
  
 | 
void __is_set_fd_config_rollangle(struct fimc_is *is, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct fd_param *fd; 
 | 
    unsigned long *p_index; 
 | 
  
 | 
    p_index = &is->config[index].p_region_index[1]; 
 | 
    fd = &is->config[index].fd; 
 | 
  
 | 
    fd->config.roll_angle = val; 
 | 
  
 | 
    if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 
 | 
        fd->config.cmd = FD_CONFIG_COMMAND_ROLL_ANGLE; 
 | 
        fd->config.err = ERROR_FD_NONE; 
 | 
        fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 
 | 
    } else { 
 | 
        fd->config.cmd |= FD_CONFIG_COMMAND_ROLL_ANGLE; 
 | 
    } 
 | 
} 
 | 
  
 | 
void __is_set_fd_config_yawangle(struct fimc_is *is, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct fd_param *fd; 
 | 
    unsigned long *p_index; 
 | 
  
 | 
    p_index = &is->config[index].p_region_index[1]; 
 | 
    fd = &is->config[index].fd; 
 | 
  
 | 
    fd->config.yaw_angle = val; 
 | 
  
 | 
    if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 
 | 
        fd->config.cmd = FD_CONFIG_COMMAND_YAW_ANGLE; 
 | 
        fd->config.err = ERROR_FD_NONE; 
 | 
        fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 
 | 
    } else { 
 | 
        fd->config.cmd |= FD_CONFIG_COMMAND_YAW_ANGLE; 
 | 
    } 
 | 
} 
 | 
  
 | 
void __is_set_fd_config_smilemode(struct fimc_is *is, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct fd_param *fd; 
 | 
    unsigned long *p_index; 
 | 
  
 | 
    p_index = &is->config[index].p_region_index[1]; 
 | 
    fd = &is->config[index].fd; 
 | 
  
 | 
    fd->config.smile_mode = val; 
 | 
  
 | 
    if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 
 | 
        fd->config.cmd = FD_CONFIG_COMMAND_SMILE_MODE; 
 | 
        fd->config.err = ERROR_FD_NONE; 
 | 
        fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 
 | 
    } else { 
 | 
        fd->config.cmd |= FD_CONFIG_COMMAND_SMILE_MODE; 
 | 
    } 
 | 
} 
 | 
  
 | 
void __is_set_fd_config_blinkmode(struct fimc_is *is, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct fd_param *fd; 
 | 
    unsigned long *p_index; 
 | 
  
 | 
    p_index = &is->config[index].p_region_index[1]; 
 | 
    fd = &is->config[index].fd; 
 | 
  
 | 
    fd->config.blink_mode = val; 
 | 
  
 | 
    if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 
 | 
        fd->config.cmd = FD_CONFIG_COMMAND_BLINK_MODE; 
 | 
        fd->config.err = ERROR_FD_NONE; 
 | 
        fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 
 | 
    } else { 
 | 
        fd->config.cmd |= FD_CONFIG_COMMAND_BLINK_MODE; 
 | 
    } 
 | 
} 
 | 
  
 | 
void __is_set_fd_config_eyedetect(struct fimc_is *is, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct fd_param *fd; 
 | 
    unsigned long *p_index; 
 | 
  
 | 
    p_index = &is->config[index].p_region_index[1]; 
 | 
    fd = &is->config[index].fd; 
 | 
  
 | 
    fd->config.eye_detect = val; 
 | 
  
 | 
    if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 
 | 
        fd->config.cmd = FD_CONFIG_COMMAND_EYES_DETECT; 
 | 
        fd->config.err = ERROR_FD_NONE; 
 | 
        fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 
 | 
    } else { 
 | 
        fd->config.cmd |= FD_CONFIG_COMMAND_EYES_DETECT; 
 | 
    } 
 | 
} 
 | 
  
 | 
void __is_set_fd_config_mouthdetect(struct fimc_is *is, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct fd_param *fd; 
 | 
    unsigned long *p_index; 
 | 
  
 | 
    p_index = &is->config[index].p_region_index[1]; 
 | 
    fd = &is->config[index].fd; 
 | 
  
 | 
    fd->config.mouth_detect = val; 
 | 
  
 | 
    if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 
 | 
        fd->config.cmd = FD_CONFIG_COMMAND_MOUTH_DETECT; 
 | 
        fd->config.err = ERROR_FD_NONE; 
 | 
        fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 
 | 
    } else { 
 | 
        fd->config.cmd |= FD_CONFIG_COMMAND_MOUTH_DETECT; 
 | 
    } 
 | 
} 
 | 
  
 | 
void __is_set_fd_config_orientation(struct fimc_is *is, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct fd_param *fd; 
 | 
    unsigned long *p_index; 
 | 
  
 | 
    p_index = &is->config[index].p_region_index[1]; 
 | 
    fd = &is->config[index].fd; 
 | 
  
 | 
    fd->config.orientation = val; 
 | 
  
 | 
    if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 
 | 
        fd->config.cmd = FD_CONFIG_COMMAND_ORIENTATION; 
 | 
        fd->config.err = ERROR_FD_NONE; 
 | 
        fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 
 | 
    } else { 
 | 
        fd->config.cmd |= FD_CONFIG_COMMAND_ORIENTATION; 
 | 
    } 
 | 
} 
 | 
  
 | 
void __is_set_fd_config_orientation_val(struct fimc_is *is, u32 val) 
 | 
{ 
 | 
    unsigned int index = is->config_index; 
 | 
    struct fd_param *fd; 
 | 
    unsigned long *p_index; 
 | 
  
 | 
    p_index = &is->config[index].p_region_index[1]; 
 | 
    fd = &is->config[index].fd; 
 | 
  
 | 
    fd->config.orientation_value = val; 
 | 
  
 | 
    if (!test_bit((PARAM_FD_CONFIG - 32), p_index)) { 
 | 
        fd->config.cmd = FD_CONFIG_COMMAND_ORIENTATION_VALUE; 
 | 
        fd->config.err = ERROR_FD_NONE; 
 | 
        fimc_is_set_param_bit(is, PARAM_FD_CONFIG); 
 | 
    } else { 
 | 
        fd->config.cmd |= FD_CONFIG_COMMAND_ORIENTATION_VALUE; 
 | 
    } 
 | 
} 
 | 
  
 | 
void fimc_is_set_initial_params(struct fimc_is *is) 
 | 
{ 
 | 
    struct global_param *global; 
 | 
    struct isp_param *isp; 
 | 
    struct drc_param *drc; 
 | 
    struct fd_param *fd; 
 | 
    unsigned long *p_index; 
 | 
    unsigned int index; 
 | 
  
 | 
    index = is->config_index; 
 | 
    global = &is->config[index].global; 
 | 
    isp = &is->config[index].isp; 
 | 
    drc = &is->config[index].drc; 
 | 
    fd = &is->config[index].fd; 
 | 
    p_index = &is->config[index].p_region_index[0]; 
 | 
  
 | 
    /* Global */ 
 | 
    global->shotmode.cmd = 1; 
 | 
    fimc_is_set_param_bit(is, PARAM_GLOBAL_SHOTMODE); 
 | 
  
 | 
    /* ISP */ 
 | 
    isp->control.cmd = CONTROL_COMMAND_START; 
 | 
    isp->control.bypass = CONTROL_BYPASS_DISABLE; 
 | 
    isp->control.err = CONTROL_ERROR_NONE; 
 | 
    fimc_is_set_param_bit(is, PARAM_ISP_CONTROL); 
 | 
  
 | 
    isp->otf_input.cmd = OTF_INPUT_COMMAND_ENABLE; 
 | 
    if (!test_bit(PARAM_ISP_OTF_INPUT, p_index)) { 
 | 
        isp->otf_input.width = DEFAULT_PREVIEW_STILL_WIDTH; 
 | 
        isp->otf_input.height = DEFAULT_PREVIEW_STILL_HEIGHT; 
 | 
        fimc_is_set_param_bit(is, PARAM_ISP_OTF_INPUT); 
 | 
    } 
 | 
    if (is->sensor->test_pattern) 
 | 
        isp->otf_input.format = OTF_INPUT_FORMAT_STRGEN_COLORBAR_BAYER; 
 | 
    else 
 | 
        isp->otf_input.format = OTF_INPUT_FORMAT_BAYER; 
 | 
    isp->otf_input.bitwidth = 10; 
 | 
    isp->otf_input.order = OTF_INPUT_ORDER_BAYER_GR_BG; 
 | 
    isp->otf_input.crop_offset_x = 0; 
 | 
    isp->otf_input.crop_offset_y = 0; 
 | 
    isp->otf_input.err = OTF_INPUT_ERROR_NONE; 
 | 
  
 | 
    isp->dma1_input.cmd = DMA_INPUT_COMMAND_DISABLE; 
 | 
    isp->dma1_input.width = 0; 
 | 
    isp->dma1_input.height = 0; 
 | 
    isp->dma1_input.format = 0; 
 | 
    isp->dma1_input.bitwidth = 0; 
 | 
    isp->dma1_input.plane = 0; 
 | 
    isp->dma1_input.order = 0; 
 | 
    isp->dma1_input.buffer_number = 0; 
 | 
    isp->dma1_input.width = 0; 
 | 
    isp->dma1_input.err = DMA_INPUT_ERROR_NONE; 
 | 
    fimc_is_set_param_bit(is, PARAM_ISP_DMA1_INPUT); 
 | 
  
 | 
    isp->dma2_input.cmd = DMA_INPUT_COMMAND_DISABLE; 
 | 
    isp->dma2_input.width = 0; 
 | 
    isp->dma2_input.height = 0; 
 | 
    isp->dma2_input.format = 0; 
 | 
    isp->dma2_input.bitwidth = 0; 
 | 
    isp->dma2_input.plane = 0; 
 | 
    isp->dma2_input.order = 0; 
 | 
    isp->dma2_input.buffer_number = 0; 
 | 
    isp->dma2_input.width = 0; 
 | 
    isp->dma2_input.err = DMA_INPUT_ERROR_NONE; 
 | 
    fimc_is_set_param_bit(is, PARAM_ISP_DMA2_INPUT); 
 | 
  
 | 
    isp->aa.cmd = ISP_AA_COMMAND_START; 
 | 
    isp->aa.target = ISP_AA_TARGET_AE | ISP_AA_TARGET_AWB; 
 | 
    fimc_is_set_param_bit(is, PARAM_ISP_AA); 
 | 
  
 | 
    if (!test_bit(PARAM_ISP_FLASH, p_index)) 
 | 
        __is_set_isp_flash(is, ISP_FLASH_COMMAND_DISABLE, 
 | 
                        ISP_FLASH_REDEYE_DISABLE); 
 | 
  
 | 
    if (!test_bit(PARAM_ISP_AWB, p_index)) 
 | 
        __is_set_isp_awb(is, ISP_AWB_COMMAND_AUTO, 0); 
 | 
  
 | 
    if (!test_bit(PARAM_ISP_IMAGE_EFFECT, p_index)) 
 | 
        __is_set_isp_effect(is, ISP_IMAGE_EFFECT_DISABLE); 
 | 
  
 | 
    if (!test_bit(PARAM_ISP_ISO, p_index)) 
 | 
        __is_set_isp_iso(is, ISP_ISO_COMMAND_AUTO, 0); 
 | 
  
 | 
    if (!test_bit(PARAM_ISP_ADJUST, p_index)) { 
 | 
        __is_set_isp_adjust(is, ISP_ADJUST_COMMAND_MANUAL_CONTRAST, 0); 
 | 
        __is_set_isp_adjust(is, 
 | 
                ISP_ADJUST_COMMAND_MANUAL_SATURATION, 0); 
 | 
        __is_set_isp_adjust(is, ISP_ADJUST_COMMAND_MANUAL_SHARPNESS, 0); 
 | 
        __is_set_isp_adjust(is, ISP_ADJUST_COMMAND_MANUAL_EXPOSURE, 0); 
 | 
        __is_set_isp_adjust(is, 
 | 
                ISP_ADJUST_COMMAND_MANUAL_BRIGHTNESS, 0); 
 | 
        __is_set_isp_adjust(is, ISP_ADJUST_COMMAND_MANUAL_HUE, 0); 
 | 
    } 
 | 
  
 | 
    if (!test_bit(PARAM_ISP_METERING, p_index)) { 
 | 
        __is_set_isp_metering(is, 0, ISP_METERING_COMMAND_CENTER); 
 | 
        __is_set_isp_metering(is, 1, 0); 
 | 
        __is_set_isp_metering(is, 2, 0); 
 | 
        __is_set_isp_metering(is, 3, 0); 
 | 
        __is_set_isp_metering(is, 4, 0); 
 | 
    } 
 | 
  
 | 
    if (!test_bit(PARAM_ISP_AFC, p_index)) 
 | 
        __is_set_isp_afc(is, ISP_AFC_COMMAND_AUTO, 0); 
 | 
  
 | 
    isp->otf_output.cmd = OTF_OUTPUT_COMMAND_ENABLE; 
 | 
    if (!test_bit(PARAM_ISP_OTF_OUTPUT, p_index)) { 
 | 
        isp->otf_output.width = DEFAULT_PREVIEW_STILL_WIDTH; 
 | 
        isp->otf_output.height = DEFAULT_PREVIEW_STILL_HEIGHT; 
 | 
        fimc_is_set_param_bit(is, PARAM_ISP_OTF_OUTPUT); 
 | 
    } 
 | 
    isp->otf_output.format = OTF_OUTPUT_FORMAT_YUV444; 
 | 
    isp->otf_output.bitwidth = 12; 
 | 
    isp->otf_output.order = 0; 
 | 
    isp->otf_output.err = OTF_OUTPUT_ERROR_NONE; 
 | 
  
 | 
    if (!test_bit(PARAM_ISP_DMA1_OUTPUT, p_index)) { 
 | 
        isp->dma1_output.cmd = DMA_OUTPUT_COMMAND_DISABLE; 
 | 
        isp->dma1_output.width = 0; 
 | 
        isp->dma1_output.height = 0; 
 | 
        isp->dma1_output.format = 0; 
 | 
        isp->dma1_output.bitwidth = 0; 
 | 
        isp->dma1_output.plane = 0; 
 | 
        isp->dma1_output.order = 0; 
 | 
        isp->dma1_output.buffer_number = 0; 
 | 
        isp->dma1_output.buffer_address = 0; 
 | 
        isp->dma1_output.notify_dma_done = 0; 
 | 
        isp->dma1_output.dma_out_mask = 0; 
 | 
        isp->dma1_output.err = DMA_OUTPUT_ERROR_NONE; 
 | 
        fimc_is_set_param_bit(is, PARAM_ISP_DMA1_OUTPUT); 
 | 
    } 
 | 
  
 | 
    if (!test_bit(PARAM_ISP_DMA2_OUTPUT, p_index)) { 
 | 
        isp->dma2_output.cmd = DMA_OUTPUT_COMMAND_DISABLE; 
 | 
        isp->dma2_output.width = 0; 
 | 
        isp->dma2_output.height = 0; 
 | 
        isp->dma2_output.format = 0; 
 | 
        isp->dma2_output.bitwidth = 0; 
 | 
        isp->dma2_output.plane = 0; 
 | 
        isp->dma2_output.order = 0; 
 | 
        isp->dma2_output.buffer_number = 0; 
 | 
        isp->dma2_output.buffer_address = 0; 
 | 
        isp->dma2_output.notify_dma_done = 0; 
 | 
        isp->dma2_output.dma_out_mask = 0; 
 | 
        isp->dma2_output.err = DMA_OUTPUT_ERROR_NONE; 
 | 
        fimc_is_set_param_bit(is, PARAM_ISP_DMA2_OUTPUT); 
 | 
    } 
 | 
  
 | 
    /* Sensor */ 
 | 
    if (!test_bit(PARAM_SENSOR_FRAME_RATE, p_index)) { 
 | 
        if (is->config_index == 0) 
 | 
            __is_set_sensor(is, 0); 
 | 
    } 
 | 
  
 | 
    /* DRC */ 
 | 
    drc->control.cmd = CONTROL_COMMAND_START; 
 | 
    __is_set_drc_control(is, CONTROL_BYPASS_ENABLE); 
 | 
  
 | 
    drc->otf_input.cmd = OTF_INPUT_COMMAND_ENABLE; 
 | 
    if (!test_bit(PARAM_DRC_OTF_INPUT, p_index)) { 
 | 
        drc->otf_input.width = DEFAULT_PREVIEW_STILL_WIDTH; 
 | 
        drc->otf_input.height = DEFAULT_PREVIEW_STILL_HEIGHT; 
 | 
        fimc_is_set_param_bit(is, PARAM_DRC_OTF_INPUT); 
 | 
    } 
 | 
    drc->otf_input.format = OTF_INPUT_FORMAT_YUV444; 
 | 
    drc->otf_input.bitwidth = 12; 
 | 
    drc->otf_input.order = 0; 
 | 
    drc->otf_input.err = OTF_INPUT_ERROR_NONE; 
 | 
  
 | 
    drc->dma_input.cmd = DMA_INPUT_COMMAND_DISABLE; 
 | 
    drc->dma_input.width = 0; 
 | 
    drc->dma_input.height = 0; 
 | 
    drc->dma_input.format = 0; 
 | 
    drc->dma_input.bitwidth = 0; 
 | 
    drc->dma_input.plane = 0; 
 | 
    drc->dma_input.order = 0; 
 | 
    drc->dma_input.buffer_number = 0; 
 | 
    drc->dma_input.width = 0; 
 | 
    drc->dma_input.err = DMA_INPUT_ERROR_NONE; 
 | 
    fimc_is_set_param_bit(is, PARAM_DRC_DMA_INPUT); 
 | 
  
 | 
    drc->otf_output.cmd = OTF_OUTPUT_COMMAND_ENABLE; 
 | 
    if (!test_bit(PARAM_DRC_OTF_OUTPUT, p_index)) { 
 | 
        drc->otf_output.width = DEFAULT_PREVIEW_STILL_WIDTH; 
 | 
        drc->otf_output.height = DEFAULT_PREVIEW_STILL_HEIGHT; 
 | 
        fimc_is_set_param_bit(is, PARAM_DRC_OTF_OUTPUT); 
 | 
    } 
 | 
    drc->otf_output.format = OTF_OUTPUT_FORMAT_YUV444; 
 | 
    drc->otf_output.bitwidth = 8; 
 | 
    drc->otf_output.order = 0; 
 | 
    drc->otf_output.err = OTF_OUTPUT_ERROR_NONE; 
 | 
  
 | 
    /* FD */ 
 | 
    __is_set_fd_control(is, CONTROL_COMMAND_STOP); 
 | 
    fd->control.bypass = CONTROL_BYPASS_DISABLE; 
 | 
  
 | 
    fd->otf_input.cmd = OTF_INPUT_COMMAND_ENABLE; 
 | 
    if (!test_bit(PARAM_FD_OTF_INPUT, p_index)) { 
 | 
        fd->otf_input.width = DEFAULT_PREVIEW_STILL_WIDTH; 
 | 
        fd->otf_input.height = DEFAULT_PREVIEW_STILL_HEIGHT; 
 | 
        fimc_is_set_param_bit(is, PARAM_FD_OTF_INPUT); 
 | 
    } 
 | 
  
 | 
    fd->otf_input.format = OTF_INPUT_FORMAT_YUV444; 
 | 
    fd->otf_input.bitwidth = 8; 
 | 
    fd->otf_input.order = 0; 
 | 
    fd->otf_input.err = OTF_INPUT_ERROR_NONE; 
 | 
  
 | 
    fd->dma_input.cmd = DMA_INPUT_COMMAND_DISABLE; 
 | 
    fd->dma_input.width = 0; 
 | 
    fd->dma_input.height = 0; 
 | 
    fd->dma_input.format = 0; 
 | 
    fd->dma_input.bitwidth = 0; 
 | 
    fd->dma_input.plane = 0; 
 | 
    fd->dma_input.order = 0; 
 | 
    fd->dma_input.buffer_number = 0; 
 | 
    fd->dma_input.width = 0; 
 | 
    fd->dma_input.err = DMA_INPUT_ERROR_NONE; 
 | 
    fimc_is_set_param_bit(is, PARAM_FD_DMA_INPUT); 
 | 
  
 | 
    __is_set_fd_config_maxface(is, 5); 
 | 
    __is_set_fd_config_rollangle(is, FD_CONFIG_ROLL_ANGLE_FULL); 
 | 
    __is_set_fd_config_yawangle(is, FD_CONFIG_YAW_ANGLE_45_90); 
 | 
    __is_set_fd_config_smilemode(is, FD_CONFIG_SMILE_MODE_DISABLE); 
 | 
    __is_set_fd_config_blinkmode(is, FD_CONFIG_BLINK_MODE_DISABLE); 
 | 
    __is_set_fd_config_eyedetect(is, FD_CONFIG_EYES_DETECT_ENABLE); 
 | 
    __is_set_fd_config_mouthdetect(is, FD_CONFIG_MOUTH_DETECT_DISABLE); 
 | 
    __is_set_fd_config_orientation(is, FD_CONFIG_ORIENTATION_DISABLE); 
 | 
    __is_set_fd_config_orientation_val(is, 0); 
 | 
} 
 |