drivers/media/video/m5mols/m5mols_controls.c - kernel/msm-4.9 - Gitiles

 /*
  * Controls for M-5MOLS 8M Pixel camera sensor with ISP
  *
  * Copyright (C) 2011 Samsung Electronics Co., Ltd.
  * Author: HeungJun Kim <riverful.kim@samsung.com>
  *
  * Copyright (C) 2009 Samsung Electronics Co., Ltd.
  * Author: Dongsoo Nathaniel Kim <dongsoo45.kim@samsung.com>
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
  * the Free Software Foundation; either version 2 of the License, or
  * (at your option) any later version.
  */

 #include <linux/i2c.h>
 #include <linux/delay.h>
 #include <linux/videodev2.h>
 #include <media/v4l2-ctrls.h>

 #include "m5mols.h"
 #include "m5mols_reg.h"

 static struct m5mols_scenemode m5mols_default_scenemode[] = {
 	[REG_SCENE_NORMAL] = {
 		REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
 		REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
 		REG_AF_NORMAL, REG_FD_OFF,
 		REG_MCC_NORMAL, REG_LIGHT_OFF, REG_FLASH_OFF,
 		5, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
 	},
 	[REG_SCENE_PORTRAIT] = {
 		REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
 		REG_CHROMA_ON, 3, REG_EDGE_ON, 4,
 		REG_AF_NORMAL, BIT_FD_EN | BIT_FD_DRAW_FACE_FRAME,
 		REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
 		6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
 	},
 	[REG_SCENE_LANDSCAPE] = {
 		REG_AE_ALL, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
 		REG_CHROMA_ON, 4, REG_EDGE_ON, 6,
 		REG_AF_NORMAL, REG_FD_OFF,
 		REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
 		6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
 	},
 	[REG_SCENE_SPORTS] = {
 		REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
 		REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
 		REG_AF_NORMAL, REG_FD_OFF,
 		REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
 		6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
 	},
 	[REG_SCENE_PARTY_INDOOR] = {
 		REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
 		REG_CHROMA_ON, 4, REG_EDGE_ON, 5,
 		REG_AF_NORMAL, REG_FD_OFF,
 		REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
 		6, REG_ISO_200, REG_CAP_NONE, REG_WDR_OFF,
 	},
 	[REG_SCENE_BEACH_SNOW] = {
 		REG_AE_CENTER, REG_AE_INDEX_10_POS, REG_AWB_AUTO, 0,
 		REG_CHROMA_ON, 4, REG_EDGE_ON, 5,
 		REG_AF_NORMAL, REG_FD_OFF,
 		REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
 		6, REG_ISO_50, REG_CAP_NONE, REG_WDR_OFF,
 	},
 	[REG_SCENE_SUNSET] = {
 		REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_PRESET,
 		REG_AWB_DAYLIGHT,
 		REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
 		REG_AF_NORMAL, REG_FD_OFF,
 		REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
 		6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
 	},
 	[REG_SCENE_DAWN_DUSK] = {
 		REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_PRESET,
 		REG_AWB_FLUORESCENT_1,
 		REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
 		REG_AF_NORMAL, REG_FD_OFF,
 		REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
 		6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
 	},
 	[REG_SCENE_FALL] = {
 		REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
 		REG_CHROMA_ON, 5, REG_EDGE_ON, 5,
 		REG_AF_NORMAL, REG_FD_OFF,
 		REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
 		6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
 	},
 	[REG_SCENE_NIGHT] = {
 		REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
 		REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
 		REG_AF_NORMAL, REG_FD_OFF,
 		REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
 		6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
 	},
 	[REG_SCENE_AGAINST_LIGHT] = {
 		REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
 		REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
 		REG_AF_NORMAL, REG_FD_OFF,
 		REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
 		6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
 	},
 	[REG_SCENE_FIRE] = {
 		REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
 		REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
 		REG_AF_NORMAL, REG_FD_OFF,
 		REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
 		6, REG_ISO_50, REG_CAP_NONE, REG_WDR_OFF,
 	},
 	[REG_SCENE_TEXT] = {
 		REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
 		REG_CHROMA_ON, 3, REG_EDGE_ON, 7,
 		REG_AF_MACRO, REG_FD_OFF,
 		REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
 		6, REG_ISO_AUTO, REG_CAP_ANTI_SHAKE, REG_WDR_ON,
 	},
 	[REG_SCENE_CANDLE] = {
 		REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
 		REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
 		REG_AF_NORMAL, REG_FD_OFF,
 		REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
 		6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
 	},
 };

 /**
  * m5mols_do_scenemode() - Change current scenemode
  * @mode:	Desired mode of the scenemode
  *
  * WARNING: The execution order is important. Do not change the order.
  */
 int m5mols_do_scenemode(struct m5mols_info *info, u8 mode)
 {
 	struct v4l2_subdev *sd = &info->sd;
 	struct m5mols_scenemode scenemode = m5mols_default_scenemode[mode];
 	int ret;

 	if (mode > REG_SCENE_CANDLE)
 		return -EINVAL;

 	ret = m5mols_lock_3a(info, false);
 	if (!ret)
 		ret = m5mols_write(sd, AE_EV_PRESET_MONITOR, mode);
 	if (!ret)
 		ret = m5mols_write(sd, AE_EV_PRESET_CAPTURE, mode);
 	if (!ret)
 		ret = m5mols_write(sd, AE_MODE, scenemode.metering);
 	if (!ret)
 		ret = m5mols_write(sd, AE_INDEX, scenemode.ev_bias);
 	if (!ret)
 		ret = m5mols_write(sd, AWB_MODE, scenemode.wb_mode);
 	if (!ret)
 		ret = m5mols_write(sd, AWB_MANUAL, scenemode.wb_preset);
 	if (!ret)
 		ret = m5mols_write(sd, MON_CHROMA_EN, scenemode.chroma_en);
 	if (!ret)
 		ret = m5mols_write(sd, MON_CHROMA_LVL, scenemode.chroma_lvl);
 	if (!ret)
 		ret = m5mols_write(sd, MON_EDGE_EN, scenemode.edge_en);
 	if (!ret)
 		ret = m5mols_write(sd, MON_EDGE_LVL, scenemode.edge_lvl);
 	if (!ret && is_available_af(info))
 		ret = m5mols_write(sd, AF_MODE, scenemode.af_range);
 	if (!ret && is_available_af(info))
 		ret = m5mols_write(sd, FD_CTL, scenemode.fd_mode);
 	if (!ret)
 		ret = m5mols_write(sd, MON_TONE_CTL, scenemode.tone);
 	if (!ret)
 		ret = m5mols_write(sd, AE_ISO, scenemode.iso);
 	if (!ret)
 		ret = m5mols_set_mode(info, REG_CAPTURE);
 	if (!ret)
 		ret = m5mols_write(sd, CAPP_WDR_EN, scenemode.wdr);
 	if (!ret)
 		ret = m5mols_write(sd, CAPP_MCC_MODE, scenemode.mcc);
 	if (!ret)
 		ret = m5mols_write(sd, CAPP_LIGHT_CTRL, scenemode.light);
 	if (!ret)
 		ret = m5mols_write(sd, CAPP_FLASH_CTRL, scenemode.flash);
 	if (!ret)
 		ret = m5mols_write(sd, CAPC_MODE, scenemode.capt_mode);
 	if (!ret)
 		ret = m5mols_set_mode(info, REG_MONITOR);

 	return ret;
 }

 static int m5mols_lock_ae(struct m5mols_info *info, bool lock)
 {
 	int ret = 0;

 	if (info->lock_ae != lock)
 		ret = m5mols_write(&info->sd, AE_LOCK,
 				lock ? REG_AE_LOCK : REG_AE_UNLOCK);
 	if (!ret)
 		info->lock_ae = lock;

 	return ret;
 }

 static int m5mols_lock_awb(struct m5mols_info *info, bool lock)
 {
 	int ret = 0;

 	if (info->lock_awb != lock)
 		ret = m5mols_write(&info->sd, AWB_LOCK,
 				lock ? REG_AWB_LOCK : REG_AWB_UNLOCK);
 	if (!ret)
 		info->lock_awb = lock;

 	return ret;
 }

 /* m5mols_lock_3a() - Lock 3A(Auto Exposure, Auto Whitebalance, Auto Focus) */
 int m5mols_lock_3a(struct m5mols_info *info, bool lock)
 {
 	int ret;

 	ret = m5mols_lock_ae(info, lock);
 	if (!ret)
 		ret = m5mols_lock_awb(info, lock);
 	/* Don't need to handle unlocking AF */
 	if (!ret && is_available_af(info) && lock)
 		ret = m5mols_write(&info->sd, AF_EXECUTE, REG_AF_STOP);

 	return ret;
 }

 /* Set exposure/auto exposure cluster */
 static int m5mols_set_exposure(struct m5mols_info *info, int exposure)
 {
 	struct v4l2_subdev *sd = &info->sd;
 	int ret;

 	ret = m5mols_lock_ae(info, exposure != V4L2_EXPOSURE_AUTO);
 	if (ret < 0)
 		return ret;

 	if (exposure == V4L2_EXPOSURE_AUTO) {
 		ret = m5mols_write(sd, AE_MODE, REG_AE_ALL);
 		if (ret < 0)
 			return ret;
 	}

 	if (exposure == V4L2_EXPOSURE_MANUAL) {
 		ret = m5mols_write(sd, AE_MODE, REG_AE_OFF);
 		if (ret == 0)
 			ret = m5mols_write(sd, AE_MAN_GAIN_MON,
 					   info->exposure->val);
 		if (ret == 0)
 			ret = m5mols_write(sd, AE_MAN_GAIN_CAP,
 					   info->exposure->val);
 	}

 	return ret;
 }

 static int m5mols_set_white_balance(struct m5mols_info *info, int awb)
 {
 	int ret;

 	ret = m5mols_lock_awb(info, !awb);
 	if (ret < 0)
 		return ret;

 	return m5mols_write(&info->sd, AWB_MODE, awb ? REG_AWB_AUTO :
 			    REG_AWB_PRESET);
 }

 static int m5mols_set_saturation(struct m5mols_info *info, int val)
 {
 	int ret = m5mols_write(&info->sd, MON_CHROMA_LVL, val);
 	if (ret < 0)
 		return ret;

 	return m5mols_write(&info->sd, MON_CHROMA_EN, REG_CHROMA_ON);
 }

 static int m5mols_set_color_effect(struct m5mols_info *info, int val)
 {
 	unsigned int m_effect = REG_COLOR_EFFECT_OFF;
 	unsigned int p_effect = REG_EFFECT_OFF;
 	unsigned int cfix_r = 0, cfix_b = 0;
 	struct v4l2_subdev *sd = &info->sd;
 	int ret = 0;

 	switch (val) {
 	case V4L2_COLORFX_BW:
 		m_effect = REG_COLOR_EFFECT_ON;
 		break;
 	case V4L2_COLORFX_NEGATIVE:
 		p_effect = REG_EFFECT_NEGA;
 		break;
 	case V4L2_COLORFX_EMBOSS:
 		p_effect = REG_EFFECT_EMBOSS;
 		break;
 	case V4L2_COLORFX_SEPIA:
 		m_effect = REG_COLOR_EFFECT_ON;
 		cfix_r = REG_CFIXR_SEPIA;
 		cfix_b = REG_CFIXB_SEPIA;
 		break;
 	}

 	ret = m5mols_write(sd, PARM_EFFECT, p_effect);
 	if (!ret)
 		ret = m5mols_write(sd, MON_EFFECT, m_effect);

 	if (ret == 0 && m_effect == REG_COLOR_EFFECT_ON) {
 		ret = m5mols_write(sd, MON_CFIXR, cfix_r);
 		if (!ret)
 			ret = m5mols_write(sd, MON_CFIXB, cfix_b);
 	}

 	v4l2_dbg(1, m5mols_debug, sd,
 		 "p_effect: %#x, m_effect: %#x, r: %#x, b: %#x (%d)\n",
 		 p_effect, m_effect, cfix_r, cfix_b, ret);

 	return ret;
 }

 static int m5mols_s_ctrl(struct v4l2_ctrl *ctrl)
 {
 	struct v4l2_subdev *sd = to_sd(ctrl);
 	struct m5mols_info *info = to_m5mols(sd);
 	int ispstate = info->mode;
 	int ret;

 	/*
 	 * If needed, defer restoring the controls until
 	 * the device is fully initialized.
 	 */
 	if (!info->isp_ready) {
 		info->ctrl_sync = 0;
 		return 0;
 	}

 	ret = m5mols_mode(info, REG_PARAMETER);
 	if (ret < 0)
 		return ret;

 	switch (ctrl->id) {
 	case V4L2_CID_ZOOM_ABSOLUTE:
 		ret = m5mols_write(sd, MON_ZOOM, ctrl->val);
 		break;

 	case V4L2_CID_EXPOSURE_AUTO:
 		ret = m5mols_set_exposure(info, ctrl->val);
 		break;

 	case V4L2_CID_AUTO_WHITE_BALANCE:
 		ret = m5mols_set_white_balance(info, ctrl->val);
 		break;

 	case V4L2_CID_SATURATION:
 		ret = m5mols_set_saturation(info, ctrl->val);
 		break;

 	case V4L2_CID_COLORFX:
 		ret = m5mols_set_color_effect(info, ctrl->val);
 		break;
 	}
 	if (ret < 0)
 		return ret;

 	return m5mols_mode(info, ispstate);
 }

 static const struct v4l2_ctrl_ops m5mols_ctrl_ops = {
 	.s_ctrl			= m5mols_s_ctrl,
 };

 int m5mols_init_controls(struct v4l2_subdev *sd)
 {
 	struct m5mols_info *info = to_m5mols(sd);
 	u16 exposure_max;
 	u16 zoom_step;
 	int ret;

 	/* Determine the firmware dependant control range and step values */
 	ret = m5mols_read_u16(sd, AE_MAX_GAIN_MON, &exposure_max);
 	if (ret < 0)
 		return ret;

 	zoom_step = is_manufacturer(info, REG_SAMSUNG_OPTICS) ? 31 : 1;

 	v4l2_ctrl_handler_init(&info->handle, 6);

 	info->auto_wb = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops,
 			V4L2_CID_AUTO_WHITE_BALANCE, 0, 1, 1, 1);

 	info->auto_exposure = v4l2_ctrl_new_std_menu(&info->handle,
 			&m5mols_ctrl_ops, V4L2_CID_EXPOSURE_AUTO,
 			1, ~0x03, V4L2_EXPOSURE_AUTO);

 	info->exposure = v4l2_ctrl_new_std(&info->handle,
 			&m5mols_ctrl_ops, V4L2_CID_EXPOSURE,
 			0, exposure_max, 1, exposure_max / 2);

 	info->saturation = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops,
 			V4L2_CID_SATURATION, 1, 5, 1, 3);

 	info->zoom = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops,
 			V4L2_CID_ZOOM_ABSOLUTE, 1, 70, zoom_step, 1);

 	info->colorfx = v4l2_ctrl_new_std_menu(&info->handle, &m5mols_ctrl_ops,
 			V4L2_CID_COLORFX, 4, 0, V4L2_COLORFX_NONE);

 	if (info->handle.error) {
 		int ret = info->handle.error;
 		v4l2_err(sd, "Failed to initialize controls: %d\n", ret);
 		v4l2_ctrl_handler_free(&info->handle);
 		return ret;
 	}

 	v4l2_ctrl_auto_cluster(2, &info->auto_exposure, 1, false);
 	sd->ctrl_handler = &info->handle;

 	return 0;
 }
	/*
	* Controls for M-5MOLS 8M Pixel camera sensor with ISP
	*
	* Copyright (C) 2011 Samsung Electronics Co., Ltd.
	* Author: HeungJun Kim <riverful.kim@samsung.com>
	*
	* Copyright (C) 2009 Samsung Electronics Co., Ltd.
	* Author: Dongsoo Nathaniel Kim <dongsoo45.kim@samsung.com>
	*
	* This program is free software; you can redistribute it and/or modify
	* it under the terms of the GNU General Public License as published by
	* the Free Software Foundation; either version 2 of the License, or
	* (at your option) any later version.
	*/

	#include <linux/i2c.h>
	#include <linux/delay.h>
	#include <linux/videodev2.h>
	#include <media/v4l2-ctrls.h>

	#include "m5mols.h"
	#include "m5mols_reg.h"

	static struct m5mols_scenemode m5mols_default_scenemode[] = {
	[REG_SCENE_NORMAL] = {
	REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
	REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
	REG_AF_NORMAL, REG_FD_OFF,
	REG_MCC_NORMAL, REG_LIGHT_OFF, REG_FLASH_OFF,
	5, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
	},
	[REG_SCENE_PORTRAIT] = {
	REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
	REG_CHROMA_ON, 3, REG_EDGE_ON, 4,
	REG_AF_NORMAL, BIT_FD_EN \| BIT_FD_DRAW_FACE_FRAME,
	REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
	6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
	},
	[REG_SCENE_LANDSCAPE] = {
	REG_AE_ALL, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
	REG_CHROMA_ON, 4, REG_EDGE_ON, 6,
	REG_AF_NORMAL, REG_FD_OFF,
	REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
	6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
	},
	[REG_SCENE_SPORTS] = {
	REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
	REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
	REG_AF_NORMAL, REG_FD_OFF,
	REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
	6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
	},
	[REG_SCENE_PARTY_INDOOR] = {
	REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
	REG_CHROMA_ON, 4, REG_EDGE_ON, 5,
	REG_AF_NORMAL, REG_FD_OFF,
	REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
	6, REG_ISO_200, REG_CAP_NONE, REG_WDR_OFF,
	},
	[REG_SCENE_BEACH_SNOW] = {
	REG_AE_CENTER, REG_AE_INDEX_10_POS, REG_AWB_AUTO, 0,
	REG_CHROMA_ON, 4, REG_EDGE_ON, 5,
	REG_AF_NORMAL, REG_FD_OFF,
	REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
	6, REG_ISO_50, REG_CAP_NONE, REG_WDR_OFF,
	},
	[REG_SCENE_SUNSET] = {
	REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_PRESET,
	REG_AWB_DAYLIGHT,
	REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
	REG_AF_NORMAL, REG_FD_OFF,
	REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
	6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
	},
	[REG_SCENE_DAWN_DUSK] = {
	REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_PRESET,
	REG_AWB_FLUORESCENT_1,
	REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
	REG_AF_NORMAL, REG_FD_OFF,
	REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
	6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
	},
	[REG_SCENE_FALL] = {
	REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
	REG_CHROMA_ON, 5, REG_EDGE_ON, 5,
	REG_AF_NORMAL, REG_FD_OFF,
	REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
	6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
	},
	[REG_SCENE_NIGHT] = {
	REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
	REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
	REG_AF_NORMAL, REG_FD_OFF,
	REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
	6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
	},
	[REG_SCENE_AGAINST_LIGHT] = {
	REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
	REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
	REG_AF_NORMAL, REG_FD_OFF,
	REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
	6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
	},
	[REG_SCENE_FIRE] = {
	REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
	REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
	REG_AF_NORMAL, REG_FD_OFF,
	REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
	6, REG_ISO_50, REG_CAP_NONE, REG_WDR_OFF,
	},
	[REG_SCENE_TEXT] = {
	REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
	REG_CHROMA_ON, 3, REG_EDGE_ON, 7,
	REG_AF_MACRO, REG_FD_OFF,
	REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
	6, REG_ISO_AUTO, REG_CAP_ANTI_SHAKE, REG_WDR_ON,
	},
	[REG_SCENE_CANDLE] = {
	REG_AE_CENTER, REG_AE_INDEX_00, REG_AWB_AUTO, 0,
	REG_CHROMA_ON, 3, REG_EDGE_ON, 5,
	REG_AF_NORMAL, REG_FD_OFF,
	REG_MCC_OFF, REG_LIGHT_OFF, REG_FLASH_OFF,
	6, REG_ISO_AUTO, REG_CAP_NONE, REG_WDR_OFF,
	},
	};

	/**
	* m5mols_do_scenemode() - Change current scenemode
	* @mode: Desired mode of the scenemode
	*
	* WARNING: The execution order is important. Do not change the order.
	*/
	int m5mols_do_scenemode(struct m5mols_info *info, u8 mode)
	{
	struct v4l2_subdev *sd = &info->sd;
	struct m5mols_scenemode scenemode = m5mols_default_scenemode[mode];
	int ret;

	if (mode > REG_SCENE_CANDLE)
	return -EINVAL;

	ret = m5mols_lock_3a(info, false);
	if (!ret)
	ret = m5mols_write(sd, AE_EV_PRESET_MONITOR, mode);
	if (!ret)
	ret = m5mols_write(sd, AE_EV_PRESET_CAPTURE, mode);
	if (!ret)
	ret = m5mols_write(sd, AE_MODE, scenemode.metering);
	if (!ret)
	ret = m5mols_write(sd, AE_INDEX, scenemode.ev_bias);
	if (!ret)
	ret = m5mols_write(sd, AWB_MODE, scenemode.wb_mode);
	if (!ret)
	ret = m5mols_write(sd, AWB_MANUAL, scenemode.wb_preset);
	if (!ret)
	ret = m5mols_write(sd, MON_CHROMA_EN, scenemode.chroma_en);
	if (!ret)
	ret = m5mols_write(sd, MON_CHROMA_LVL, scenemode.chroma_lvl);
	if (!ret)
	ret = m5mols_write(sd, MON_EDGE_EN, scenemode.edge_en);
	if (!ret)
	ret = m5mols_write(sd, MON_EDGE_LVL, scenemode.edge_lvl);
	if (!ret && is_available_af(info))
	ret = m5mols_write(sd, AF_MODE, scenemode.af_range);
	if (!ret && is_available_af(info))
	ret = m5mols_write(sd, FD_CTL, scenemode.fd_mode);
	if (!ret)
	ret = m5mols_write(sd, MON_TONE_CTL, scenemode.tone);
	if (!ret)
	ret = m5mols_write(sd, AE_ISO, scenemode.iso);
	if (!ret)
	ret = m5mols_set_mode(info, REG_CAPTURE);
	if (!ret)
	ret = m5mols_write(sd, CAPP_WDR_EN, scenemode.wdr);
	if (!ret)
	ret = m5mols_write(sd, CAPP_MCC_MODE, scenemode.mcc);
	if (!ret)
	ret = m5mols_write(sd, CAPP_LIGHT_CTRL, scenemode.light);
	if (!ret)
	ret = m5mols_write(sd, CAPP_FLASH_CTRL, scenemode.flash);
	if (!ret)
	ret = m5mols_write(sd, CAPC_MODE, scenemode.capt_mode);
	if (!ret)
	ret = m5mols_set_mode(info, REG_MONITOR);

	return ret;
	}

	static int m5mols_lock_ae(struct m5mols_info *info, bool lock)
	{
	int ret = 0;

	if (info->lock_ae != lock)
	ret = m5mols_write(&info->sd, AE_LOCK,
	lock ? REG_AE_LOCK : REG_AE_UNLOCK);
	if (!ret)
	info->lock_ae = lock;

	return ret;
	}

	static int m5mols_lock_awb(struct m5mols_info *info, bool lock)
	{
	int ret = 0;

	if (info->lock_awb != lock)
	ret = m5mols_write(&info->sd, AWB_LOCK,
	lock ? REG_AWB_LOCK : REG_AWB_UNLOCK);
	if (!ret)
	info->lock_awb = lock;

	return ret;
	}

	/* m5mols_lock_3a() - Lock 3A(Auto Exposure, Auto Whitebalance, Auto Focus) */
	int m5mols_lock_3a(struct m5mols_info *info, bool lock)
	{
	int ret;

	ret = m5mols_lock_ae(info, lock);
	if (!ret)
	ret = m5mols_lock_awb(info, lock);
	/* Don't need to handle unlocking AF */
	if (!ret && is_available_af(info) && lock)
	ret = m5mols_write(&info->sd, AF_EXECUTE, REG_AF_STOP);

	return ret;
	}

	/* Set exposure/auto exposure cluster */
	static int m5mols_set_exposure(struct m5mols_info *info, int exposure)
	{
	struct v4l2_subdev *sd = &info->sd;
	int ret;

	ret = m5mols_lock_ae(info, exposure != V4L2_EXPOSURE_AUTO);
	if (ret < 0)
	return ret;

	if (exposure == V4L2_EXPOSURE_AUTO) {
	ret = m5mols_write(sd, AE_MODE, REG_AE_ALL);
	if (ret < 0)
	return ret;
	}

	if (exposure == V4L2_EXPOSURE_MANUAL) {
	ret = m5mols_write(sd, AE_MODE, REG_AE_OFF);
	if (ret == 0)
	ret = m5mols_write(sd, AE_MAN_GAIN_MON,
	info->exposure->val);
	if (ret == 0)
	ret = m5mols_write(sd, AE_MAN_GAIN_CAP,
	info->exposure->val);
	}

	return ret;
	}

	static int m5mols_set_white_balance(struct m5mols_info *info, int awb)
	{
	int ret;

	ret = m5mols_lock_awb(info, !awb);
	if (ret < 0)
	return ret;

	return m5mols_write(&info->sd, AWB_MODE, awb ? REG_AWB_AUTO :
	REG_AWB_PRESET);
	}

	static int m5mols_set_saturation(struct m5mols_info *info, int val)
	{
	int ret = m5mols_write(&info->sd, MON_CHROMA_LVL, val);
	if (ret < 0)
	return ret;

	return m5mols_write(&info->sd, MON_CHROMA_EN, REG_CHROMA_ON);
	}

	static int m5mols_set_color_effect(struct m5mols_info *info, int val)
	{
	unsigned int m_effect = REG_COLOR_EFFECT_OFF;
	unsigned int p_effect = REG_EFFECT_OFF;
	unsigned int cfix_r = 0, cfix_b = 0;
	struct v4l2_subdev *sd = &info->sd;
	int ret = 0;

	switch (val) {
	case V4L2_COLORFX_BW:
	m_effect = REG_COLOR_EFFECT_ON;
	break;
	case V4L2_COLORFX_NEGATIVE:
	p_effect = REG_EFFECT_NEGA;
	break;
	case V4L2_COLORFX_EMBOSS:
	p_effect = REG_EFFECT_EMBOSS;
	break;
	case V4L2_COLORFX_SEPIA:
	m_effect = REG_COLOR_EFFECT_ON;
	cfix_r = REG_CFIXR_SEPIA;
	cfix_b = REG_CFIXB_SEPIA;
	break;
	}

	ret = m5mols_write(sd, PARM_EFFECT, p_effect);
	if (!ret)
	ret = m5mols_write(sd, MON_EFFECT, m_effect);

	if (ret == 0 && m_effect == REG_COLOR_EFFECT_ON) {
	ret = m5mols_write(sd, MON_CFIXR, cfix_r);
	if (!ret)
	ret = m5mols_write(sd, MON_CFIXB, cfix_b);
	}

	v4l2_dbg(1, m5mols_debug, sd,
	"p_effect: %#x, m_effect: %#x, r: %#x, b: %#x (%d)\n",
	p_effect, m_effect, cfix_r, cfix_b, ret);

	return ret;
	}

	static int m5mols_s_ctrl(struct v4l2_ctrl *ctrl)
	{
	struct v4l2_subdev *sd = to_sd(ctrl);
	struct m5mols_info *info = to_m5mols(sd);
	int ispstate = info->mode;
	int ret;

	/*
	* If needed, defer restoring the controls until
	* the device is fully initialized.
	*/
	if (!info->isp_ready) {
	info->ctrl_sync = 0;
	return 0;
	}

	ret = m5mols_mode(info, REG_PARAMETER);
	if (ret < 0)
	return ret;

	switch (ctrl->id) {
	case V4L2_CID_ZOOM_ABSOLUTE:
	ret = m5mols_write(sd, MON_ZOOM, ctrl->val);
	break;

	case V4L2_CID_EXPOSURE_AUTO:
	ret = m5mols_set_exposure(info, ctrl->val);
	break;

	case V4L2_CID_AUTO_WHITE_BALANCE:
	ret = m5mols_set_white_balance(info, ctrl->val);
	break;

	case V4L2_CID_SATURATION:
	ret = m5mols_set_saturation(info, ctrl->val);
	break;

	case V4L2_CID_COLORFX:
	ret = m5mols_set_color_effect(info, ctrl->val);
	break;
	}
	if (ret < 0)
	return ret;

	return m5mols_mode(info, ispstate);
	}

	static const struct v4l2_ctrl_ops m5mols_ctrl_ops = {
	.s_ctrl = m5mols_s_ctrl,
	};

	int m5mols_init_controls(struct v4l2_subdev *sd)
	{
	struct m5mols_info *info = to_m5mols(sd);
	u16 exposure_max;
	u16 zoom_step;
	int ret;

	/* Determine the firmware dependant control range and step values */
	ret = m5mols_read_u16(sd, AE_MAX_GAIN_MON, &exposure_max);
	if (ret < 0)
	return ret;

	zoom_step = is_manufacturer(info, REG_SAMSUNG_OPTICS) ? 31 : 1;

	v4l2_ctrl_handler_init(&info->handle, 6);

	info->auto_wb = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops,
	V4L2_CID_AUTO_WHITE_BALANCE, 0, 1, 1, 1);

	info->auto_exposure = v4l2_ctrl_new_std_menu(&info->handle,
	&m5mols_ctrl_ops, V4L2_CID_EXPOSURE_AUTO,
	1, ~0x03, V4L2_EXPOSURE_AUTO);

	info->exposure = v4l2_ctrl_new_std(&info->handle,
	&m5mols_ctrl_ops, V4L2_CID_EXPOSURE,
	0, exposure_max, 1, exposure_max / 2);

	info->saturation = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops,
	V4L2_CID_SATURATION, 1, 5, 1, 3);

	info->zoom = v4l2_ctrl_new_std(&info->handle, &m5mols_ctrl_ops,
	V4L2_CID_ZOOM_ABSOLUTE, 1, 70, zoom_step, 1);

	info->colorfx = v4l2_ctrl_new_std_menu(&info->handle, &m5mols_ctrl_ops,
	V4L2_CID_COLORFX, 4, 0, V4L2_COLORFX_NONE);

	if (info->handle.error) {
	int ret = info->handle.error;
	v4l2_err(sd, "Failed to initialize controls: %d\n", ret);
	v4l2_ctrl_handler_free(&info->handle);
	return ret;
	}

	v4l2_ctrl_auto_cluster(2, &info->auto_exposure, 1, false);
	sd->ctrl_handler = &info->handle;

	return 0;
	}