int sr130pc10_sensor_config(void __user *argp)
{
struct sensor_cfg_data cfg_data;
long rc = 0;
if (copy_from_user(&cfg_data,
(void *)argp,
sizeof(struct sensor_cfg_data)))
return -EFAULT;
// printk("sr130pc10_ioctl,************ cfgtype = %d, mode = %d\n",
// cfg_data.cfgtype, cfg_data.mode);
switch (cfg_data.cfgtype)
{
case CFG_SET_MODE:
//printk("CFG_SET_MODE************ \n");
rc = sr130pc10_set_sensor_mode(
cfg_data.mode);
break;
case CFG_SET_EFFECT:
printk("sr130pc10_sensor_ext_config, EXT_CFG_SET_EFFECT\n");
rc = sr130pc10_set_effect(cfg_data.mode);
break;
default:
rc = -EFAULT;
break;
}
return rc;
}
int sr130pc10_sensor_config(struct msm_sensor_ctrl_t *s_ctrl,
void __user *argp)
{
struct sensor_cfg_data cfg_data;
long rc = 0;
if (copy_from_user(&cfg_data,
(void *)argp, sizeof(struct sensor_cfg_data)))
return -EFAULT;
printk(KERN_DEBUG "sr130pc10_ioctl, cfgtype = %d, mode = %d\n",
cfg_data.cfgtype, cfg_data.mode);
switch (cfg_data.cfgtype) {
case CFG_SET_MODE:
rc = sr130pc10_set_sensor_mode(cfg_data.mode);
break;
default:
rc = 0;
break;
}
return rc;
}
int sr130pc10_sensor_ext_config(void __user *argp)
{
long ext_config_return = 0;
sensor_ext_cfg_data cfg_data;
int exposureTime_value1 = 0, exposureTime_value2 = 0, exposureTime_value3 = 0;
int exposureTime = 0;
if (copy_from_user((void *)&cfg_data, (const void *)argp, sizeof(cfg_data)))
return -EFAULT;
//printk("sr130pc10_sensor_ext_config, cfg_data.cmd=%d\n", cfg_data.cmd);
switch(cfg_data.cmd)
{
case EXT_CFG_SET_EFFECT:
sr1_effect = cfg_data.value_1;
ext_config_return = sr130pc10_set_effect(sr1_effect);
break;
case EXT_CFG_GET_EXIF_INFO:
printk("[SR130PC10] EXT_CFG_GET_EXIF_INFO\n");
sr130pc10_sensor_write(0x03, 0x20);
sr130pc10_sensor_read(0x80, &exposureTime_value1);
sr130pc10_sensor_read(0x81, &exposureTime_value2);
sr130pc10_sensor_read(0x82, &exposureTime_value3);
// MCLK = 24 MHz. Divide by 24000 to get exposure time in msec.
exposureTime = ((exposureTime_value1<<19) + (exposureTime_value2<<11) + (exposureTime_value3<<3)) / 24000;
cfg_data.value_1 = exposureTime;
printk("[SR130PC10] EXT_CFG_GET_EXIF_INFO: A(%x), B(%x), C(%x)\n", exposureTime_value1, exposureTime_value2, exposureTime_value3);
printk("[SR130PC10] exposureTime=%d\n", exposureTime);
break;
case EXT_CFG_SET_BRIGHTNESS:
// printk(KERN_ERR "[CAMDRV/SR130PC10] EXT_CFG_SET_BRIGHTNESS *** ( %d) brightness =%d preview_enable = %d \n",cfg_data.value_1, ,brightness,preview_enable);
if((brightness == 0) && (preview_enable == 0)){
//Brightness control should be applied only once before preview is enabled
ext_config_return = sr130pc10_set_exposure_value(cfg_data.value_1);
brightness = 1;
}
//P110909-1364 : running camera, control Brightness, take a shot and then check image in quick view, return to preview
//error : there’s difference on brightness before Quick view and after
//This created a side effect so chaged the condition to ||
if((brightness) || (preview_enable))
//This enables when the used tries to change the exposure from UI
ext_config_return = sr130pc10_set_exposure_value(cfg_data.value_1);
break;
case EXT_CFG_SET_FPS_MODE:
// printk(KERN_ERR "[CAMDRV/SR130PC100] EXT_CFG_SET_FPS_MODE ***(%d %d)\n",cfg_data.cmd,cfg_data.value_1);
sr130pc10_set_fps_mode(cfg_data.value_1);
break;
case EXT_CFG_SET_WB:
sr1_whiteBalance = cfg_data.value_1;
ext_config_return = sr130pc10_set_whitebalance(sr1_whiteBalance);
break;
case EXT_CFG_SET_DTP:
printk(KERN_ERR "[SR130PC10] EXT_CFG_SET_DTP (%d %d)\n",cfg_data.cmd,cfg_data.value_1);
ext_config_return = sr130pc10_set_dtp(cfg_data.value_1);
if(cfg_data.value_1 == 0) {
cfg_data.value_2 = 2;
} else if(cfg_data.value_1 == 1) {
cfg_data.value_2 = 3;
}
break;
default: break;
}
if(copy_to_user((void *)argp, (const void *)&cfg_data, sizeof(cfg_data)))
printk("[sr130pc10]%s fail on copy_to_user!\n", __func__);
#if 0
struct sensor_cfg_data cfg_data;
long rc = 0;
unsigned int value_1, value_2, value_3;
if (copy_from_user(&cfg_data, (void *)argp, sizeof(struct sensor_cfg_data)))
return -EFAULT;*/
/* down(&sr130pc10_sem); */
printk("sr130pc10_ioctl, cfgtype = %d, mode = %d\n", \
cfg_data.cfgtype, cfg_data.mode);
switch (cfg_data.cfgtype) {
case CFG_SET_MODE:
rc = sr130pc10_set_sensor_mode(cfg_data.mode);
break;
case CFG_SET_EFFECT:
rc = sr130pc10_set_effect(cfg_data.mode, cfg_data.cfg.effect);
break;
case CFG_SET_EXPOSURE_VALUE:
rc = sr130pc10_set_exposure_value(cfg_data.mode, cfg_data.cfg.ev);
break;
case CFG_SET_WB:
rc = sr130pc10_set_whitebalance(cfg_data.mode, cfg_data.cfg.wb);
break;
case CFG_SET_ROTATION:
rc = sr130pc10_set_rotation(cfg_data.cfg.rotation);
break;
case CFG_SET_DATALINE_CHECK:
if(cfg_data.cfg.dataline)
{
printk("[SR130PC10] CFG_SET_DATALINE_CHECK ON\n");
sr130pc10_sensor_write(0x03, 0x00);
sr130pc10_sensor_write(0x50, 0x05);
factory_test = 1;
}
else
{
printk("[SR130PC10] CFG_SET_DATALINE_CHECK OFF \n");
sr130pc10_sensor_write(0x03, 0x00);
sr130pc10_sensor_write(0x50, 0x00);
}
break;
case CFG_GET_AF_MAX_STEPS:
default:
// rc = -EINVAL;
rc = 0;
break;
}
/* up(&sr130pc10_sem); */
#endif
return ext_config_return;
}
static int sr130pc10_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl)
{
/* struct i2c_client *client = v4l2_get_subdevdata(sd); */
struct sr130pc10_state *state = to_state(sd);
int err = 0;
cam_info("ctrl->id : %d, value=%d\n", ctrl->id - V4L2_CID_PRIVATE_BASE,
ctrl->value);
if ((ctrl->id != V4L2_CID_CAMERA_CHECK_DATALINE)
&& (ctrl->id != V4L2_CID_CAMERA_SENSOR_MODE)
&& ((ctrl->id != V4L2_CID_CAMERA_VT_MODE))
&& (!state->initialized)) {
cam_warn("camera isn't initialized\n");
return 0;
}
switch (ctrl->id) {
case V4L2_CID_CAM_PREVIEW_ONOFF:
if (ctrl->value)
err = sr130pc10_set_preview_start(sd);
else
err = sr130pc10_set_preview_stop(sd);
cam_dbg("V4L2_CID_CAM_PREVIEW_ONOFF [%d]\n", ctrl->value);
break;
case V4L2_CID_CAM_CAPTURE:
err = sr130pc10_set_capture_start(sd);
cam_dbg("V4L2_CID_CAM_CAPTURE\n");
break;
case V4L2_CID_CAMERA_BRIGHTNESS:
err = sr130pc10_set_brightness(sd, ctrl);
cam_dbg("V4L2_CID_CAMERA_BRIGHTNESS [%d]\n", ctrl->value);
break;
case V4L2_CID_CAMERA_VT_MODE:
state->vt_mode = ctrl->value;
break;
case V4L2_CID_CAMERA_CHECK_DATALINE:
state->check_dataline = ctrl->value;
cam_dbg("check_dataline = %d\n", state->check_dataline);
err = 0;
break;
case V4L2_CID_CAMERA_SENSOR_MODE:
err = sr130pc10_set_sensor_mode(sd, ctrl);
cam_dbg("sensor_mode = %d\n", ctrl->value);
break;
case V4L2_CID_CAMERA_CHECK_DATALINE_STOP:
err = sr130pc10_check_dataline_stop(sd);
break;
case V4L2_CID_CAMERA_FRAME_RATE:
cam_dbg("do nothing\n");
break;
default:
cam_err("ERR(ENOIOCTLCMD)\n");
/* no errors return.*/
err = 0;
}
cam_dbg("X\n");
return err;
}
int sr130pc10_sensor_config(void __user *argp)
{
struct sensor_cfg_data cfg_data;
long rc = 0;
if (copy_from_user(&cfg_data,
(void *)argp, sizeof(struct sensor_cfg_data)))
return -EFAULT;
/* down(&sr130pc10_sem); */
printk(KERN_DEBUG "sr130pc10_ioctl, cfgtype = %d, mode = %d\n",
cfg_data.cfgtype, cfg_data.mode);
switch (cfg_data.cfgtype) {
case CFG_SET_MODE:
rc = sr130pc10_set_sensor_mode(cfg_data.mode);
break;
case CFG_SET_EFFECT:
rc = sr130pc10_set_effect(cfg_data.mode, cfg_data.cfg.effect);
break;
case CFG_SET_EXPOSURE_VALUE:
rc = sr130pc10_set_exposure_value(cfg_data.mode,
cfg_data.cfg.ev);
break;
case CFG_SET_WB:
rc = sr130pc10_set_whitebalance(cfg_data.mode, cfg_data.cfg.wb);
break;
case CFG_SET_ROTATION:
rc = sr130pc10_set_rotation(cfg_data.cfg.rotation);
break;
case CFG_SET_DATALINE_CHECK:
if (cfg_data.cfg.dataline) {
printk(KERN_DEBUG
"[SR130PC10] CFG_SET_DATALINE_CHECK ON\n");
sr130pc10_sensor_write(0x03, 0x00);
sr130pc10_sensor_write(0x50, 0x05);
factory_test = 1;
} else {
printk(KERN_DEBUG
"[SR130PC10] CFG_SET_DATALINE_CHECK OFF\n");
sr130pc10_sensor_write(0x03, 0x00);
sr130pc10_sensor_write(0x50, 0x00);
}
break;
case CFG_GET_AF_MAX_STEPS:
default:
/* rc = -EINVAL; */
rc = 0;
break;
}
/* up(&sr130pc10_sem); */
return rc;
}
