static int sr130pc10_exif_shutter_speed(void)
{
uint32_t shutter_speed = 0;
unsigned short val1, val2, val3;
sr130pc10_sensor_write(0x03, 0x20);
sr130pc10_sensor_read(0x80, &val1);
sr130pc10_sensor_read(0x81, &val2);
sr130pc10_sensor_read(0x82, &val3);
shutter_speed = 24000000 / ((val1<<19) + (val2<<11)+(val3<<3));
pr_info("[%s]shutter_speed(%d)\n", __func__, shutter_speed);
return (int)shutter_speed;
}
static int sr130pc10_start(void)
{
int rc = 0;
u8 data[2] = {0xEF, 0x01};
u8 vender[1] = {0xC5};
u8 version[1] = {0xC6};
u8 vendor_id = 0xff, sw_ver = 0xff;
printk(KERN_ERR "[CAMDRV/SR130PC10] %s E\n",__func__);
/*
rc = sr130pc10_sensor_write(0xEF, 0x01);
rc = sr130pc10_sensor_read(0xC5, &vendor_id);
rc = sr130pc10_sensor_write(0xEF, 0x01);
rc = sr130pc10_sensor_read(0xC6, &sw_ver);
*/
rc = sr130pc10_sensor_write(0x03, 0x00);
rc = sr130pc10_sensor_read(0x04, &vendor_id);
printk("[CAMDRV/SR130PC10]=================================rc=%d\n",rc);
printk("[CAMDRV/SR130PC10] [VGA CAM] vendor_id ID : 0x%x\n", vendor_id);
// printk("[CAMDRV/SR130PC10] [VGA CAM] software version : 0x%x\n", sw_ver);
// printk("[CAMDRV/SR130PC10]=================================\n");
//TELECA_PS_UPDATE
if (vendor_id != 0x94){
printk(" VENDOR not equal\n");
//return -1;
}
return rc;
}
static int sr130pc10_exif_iso(void)
{
uint32_t iso_value = 0;
unsigned short gain;
int calc_gain;
sr130pc10_sensor_write(0x03, 0x20);
sr130pc10_sensor_read(0xb0, &gain);
calc_gain = (gain/16) * 10000;
if (calc_gain < 8750)
iso_value = 50;
else if (calc_gain < 17500)
iso_value = 100;
else if (calc_gain < 46250)
iso_value = 200;
else if (calc_gain < 69375)
iso_value = 400;
else if (calc_gain < 138750)
iso_value = 800;
else
iso_value = 1600;
pr_info("[%s]iso_value(%d)\n", __func__, iso_value);
return (int)iso_value ;
}
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;
}
void sensor_rough_control_sr130pc10(void __user *arg)
{
sensor_ext_cfg_data ctrl_info;
/*
int Exptime;
int Expmax;
unsigned short read_1, read_2, read_3;
*/
printk("[SR130PC10] sensor_rough_control\n");
if(copy_from_user((void *)&ctrl_info, (const void *)arg, sizeof(ctrl_info)))
{
printk("<=SR130PC10=> %s fail copy_from_user!\n", __func__);
}
printk("<=SR130PC10=> TEST %d %d %d %d %d \n", ctrl_info.cmd, ctrl_info.device_id, ctrl_info.value_1, ctrl_info.value_2, ctrl_info.value_3);
switch(ctrl_info.cmd)
{
case PCAM_CONNECT_CHECK:
printk("[SR130PC10] PCAM_CONNECT_CHECK\n");
int rc = 0;
rc = sr130pc10_sensor_write(0x03, 0x00);
if(rc < 0) //check sensor connection
{
printk("[SR130PC10] Connect error\n");
ctrl_info.value_1 = 1;
}
break;
case PCAM_EXPOSURE_TIME:
printk("[SR130PC10] PCAM_EXPOSURE_TIME\n");
sr130pc10_sensor_write(0x03, 0x20);
sr130pc10_sensor_read(0x80, &ctrl_info.value_1);
sr130pc10_sensor_read(0x81, &ctrl_info.value_2);
sr130pc10_sensor_read(0x82, &ctrl_info.value_3);
printk("[SR130PC10] PCAM_EXPOSURE_TIME : A(%x), B(%x), C(%x)\n]",ctrl_info.value_1,ctrl_info.value_2,ctrl_info.value_3);
break;
case PCAM_ISO_SPEED:
printk("[SR130PC10] PCAM_ISO_SPEED\n");
sr130pc10_sensor_write(0x03, 0x20);
sr130pc10_sensor_read(0xb0, &ctrl_info.value_1);
break;
case PCAM_PREVIEW_FPS:
printk("[SR130PC10] PCAM_PREVIEW_FPS : %d\n", ctrl_info.device_id);
if(ctrl_info.device_id == 15)
sr130pc10_sensor_write_list(sr130pc10_vt_fps_15, sizeof(sr130pc10_vt_fps_15)/sizeof(sr130pc10_vt_fps_15[0]),"sr130pc10_vt_fps_15");
break;
default :
printk("<=SR130PC10=> Unexpected mode on sensor_rough_control!!!\n");
break;
}
if(copy_to_user((void *)arg, (const void *)&ctrl_info, sizeof(ctrl_info)))
{
printk("<=SR130PC10=> %s fail on copy_to_user!\n", __func__);
}
}
