/* Copyright (c) 2014-2015, The Linux Foundation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 and * only version 2 as published by the Free Software Foundation. * * 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 "msm_sensor.h" #include "msm_cci.h" #include "msm_camera_io_util.h" #define GC0310_SENSOR_NAME "gc0310" #define PLATFORM_DRIVER_NAME "msm_camera_gc0310" #define gc0310_obj gc0310_##obj /*#define CONFIG_MSMB_CAMERA_DEBUG*/ #undef CDBG #ifdef CONFIG_MSMB_CAMERA_DEBUG #define CDBG(fmt, args...) pr_err(fmt, ##args) #else #define CDBG(fmt, args...) do { } while (0) #endif DEFINE_MSM_MUTEX(gc0310_mut); static struct msm_sensor_ctrl_t gc0310_s_ctrl; static struct msm_sensor_power_setting gc0310_power_setting[] = { { .seq_type = SENSOR_GPIO, .seq_val = SENSOR_GPIO_STANDBY, .config_val = GPIO_OUT_LOW, .delay = 5, }, { .seq_type = SENSOR_GPIO, .seq_val = SENSOR_GPIO_STANDBY, .config_val = GPIO_OUT_HIGH, .delay = 1, }, { .seq_type = SENSOR_VREG, .seq_val = CAM_VDIG, .config_val = 0, .delay = 5, }, { .seq_type = SENSOR_VREG, .seq_val = CAM_VANA, .config_val = 0, .delay = 0, }, { .seq_type = SENSOR_CLK, .seq_val = SENSOR_CAM_MCLK, .config_val = 24000000, .delay = 10, }, { .seq_type = SENSOR_GPIO, .seq_val = SENSOR_GPIO_STANDBY, .config_val = GPIO_OUT_LOW, .delay = 5, }, { .seq_type = SENSOR_I2C_MUX, .seq_val = 0, .config_val = 0, .delay = 0, }, }; // XXX-NDM: QC left MIPI disabled (for power) in P3:0x10 - I'd rather see it on for now static struct msm_camera_i2c_reg_array gc0310_recommend_setting_list[] = { //Actual_window_size=1280*720 //MCLK=24MHz,MIPI_clock=456Mhz,row_time=43.28us //pixel_line=2467,frame_line=768 ////////////////////////////////////////// /////////////////////// SYS ////////////// ////////////////////////////////////////// {0xf7, 0x01}, {0xf8, 0x12}, {0xf9, 0x0a}, {0xfc, 0x0e}, {0xfd, 0x00}, ///////////////////////////////// ///////// Analog //////////// ///////////////////////////////// {0xfe, 0x00}, {0x03, 0x02}, {0x04, 0xb5}, {0x05, 0x02}, {0x06, 0x48}, {0x07, 0x00}, //vb {0x08, 0x10}, {0x09, 0x00}, //row start {0x0a, 0x20}, // {0x0b, 0x00}, //col start {0x0c, 0x20}, {0x0d, 0x02}, //height 736 {0x0e, 0xe0}, {0x0f, 0x05}, //width 1296 {0x10, 0x10}, {0x17, 0xd5}, //cfa {0x18, 0x02}, {0x19, 0x2b}, {0x1b, 0xf1}, {0x1c, 0x2c}, {0x1e, 0x70}, {0x1f, 0xa0}, //gamma {0x20, 0xca}, //gamma offset {0x25, 0xc1}, //[7:6]txl_s_mode {0x26, 0x0e}, {0x27, 0x20}, //[5:4]txl_drv_mode {0x29, 0x40}, //EQP {0x2b, 0x88}, //init_rampb_mode {0x2f, 0xf4}, {0x32, 0x1a}, {0x37, 0xff}, {0x38, 0x03}, //head_acc_en off {0xcd, 0xa8}, {0xce, 0xcd}, {0xd1, 0x9d}, //vref {0xd3, 0x33}, {0xd8, 0xa0}, {0xd9, 0xfa}, {0xda, 0xc3}, //[7:6] ctdsun {0xe1, 0x24}, //[3:0]post tx width x4 {0xe3, 0x01}, {0xe4, 0xf8}, {0xe6, 0x20}, //ramps_offset {0xe7, 0xca}, //[7:6]wen_U {0xe8, 0x00}, {0xe9, 0x00}, {0xea, 0x00}, {0xeb, 0x00}, ///////////////////////////////// ////////// ISP ////////////////// ///////////////////////////////// {0xfe, 0x00}, {0x80, 0x50}, {0x88, 0x03}, {0x89, 0x03}, {0x8a, 0xb3}, {0x8d, 0x03}, ///////////////////////////////// ////////// crop ///////////////// ///////////////////////////////// {0xfe, 0x00}, {0x90, 0x01}, {0x91, 0x00}, {0x92, 0x02}, {0x93, 0x00}, {0x94, 0x01}, {0x95, 0x02}, {0x96, 0xd0}, //720 {0x97, 0x05}, {0x98, 0x00}, //1280 ///////////////////////////////// ////////// BLK /////////// ///////////////////////////////// {0xfe, 0x00}, {0x40, 0x22}, {0x4e, 0x3c}, {0x4f, 0x00}, {0x60, 0x00}, {0x61, 0x80}, ///////////////////////////////// /////// gain //////////////////// ///////////////////////////////// {0xfe, 0x00}, {0xb0, 0x48}, //global gain {0xb1, 0x01}, {0xb2, 0x00}, {0xb3, 0x40}, {0xb4, 0x40}, {0xb5, 0x40}, {0xb6, 0x00}, ///////////////////////////////// /////// dd ////////////////////// ///////////////////////////////// {0xfe, 0x02}, {0x80, 0x08}, {0x83, 0x60}, {0x84, 0x80}, {0x85, 0x60}, {0x86, 0x30}, {0x87, 0xa0}, {0x88, 0x80}, {0x89, 0x40}, ///////////////////////////////// /////// ASDE //////////////////// ///////////////////////////////// {0xfe, 0x02}, {0xa0, 0x48}, {0xa3, 0x45}, ///////////////////////////////// ////////// dark sun ///////////// ///////////////////////////////// {0xfe, 0x00}, {0x68, 0xc7}, //87 {0x6c, 0x83}, {0x6e, 0xc4}, ///////////////////////////////// ///////// WB offset ///////////// ///////////////////////////////// {0xfe, 0x00}, {0x3c, 0x00}, {0x3d, 0x00}, {0x3f, 0x00}, ///////////////////////////////// /////// mipi //////////////////// ///////////////////////////////// {0xfe, 0x03}, {0x01, 0x03}, {0x02, 0x33}, {0x03, 0x93}, {0x04, 0x04}, {0x05, 0x00}, {0x06, 0x80}, {0x10, 0x90}, {0x11, 0x2b}, {0x12, 0x40}, {0x13, 0x06}, {0x15, 0x02}, {0x21, 0x10}, {0x22, 0x03}, {0x23, 0x30}, {0x24, 0x02}, {0x25, 0x15}, {0x26, 0x05}, {0x29, 0x03}, {0x2a, 0x0a}, {0x2b, 0x05}, {0xfe, 0x00}, }; static struct msm_camera_i2c_reg_setting gc0310_recommend_setting[] = { { .reg_setting = gc0310_recommend_setting_list, .size = ARRAY_SIZE(gc0310_recommend_setting_list), .addr_type = MSM_CAMERA_I2C_BYTE_ADDR, .data_type = MSM_CAMERA_I2C_BYTE_DATA, .delay = 0, }, }; static struct v4l2_subdev_info gc0310_subdev_info[] = { { .code = V4L2_MBUS_FMT_YUYV8_2X8, .colorspace = V4L2_COLORSPACE_JPEG, .fmt = 1, .order = 0, }, }; // XXX-NDM: This enables the camera - but we're already enabled (see above XXX) static struct msm_camera_i2c_reg_array gc0310_start_settings_list[] = { {0xfe, 0x03,}, {0x10, 0x94,}, {0xfe, 0x00,}, }; static struct msm_camera_i2c_reg_setting gc0310_start_settings[] = { { .reg_setting = gc0310_start_settings_list, .size = ARRAY_SIZE(gc0310_start_settings_list), .addr_type = MSM_CAMERA_I2C_BYTE_ADDR, .data_type = MSM_CAMERA_I2C_BYTE_DATA, .delay = 0, }, }; static struct msm_camera_i2c_reg_array gc0310_stop_settings_list[] = { {0xfe, 0x03,}, {0x10, 0x84,}, {0xfe, 0x00,}, }; static struct msm_camera_i2c_reg_setting gc0310_stop_settings[] = { { .reg_setting = gc0310_stop_settings_list, .size = ARRAY_SIZE(gc0310_stop_settings_list), .addr_type = MSM_CAMERA_I2C_BYTE_ADDR, .data_type = MSM_CAMERA_I2C_BYTE_DATA, .delay = 0, }, }; static const struct i2c_device_id gc0310_i2c_id[] = { {GC0310_SENSOR_NAME, (kernel_ulong_t)&gc0310_s_ctrl}, { } }; static int32_t msm_gc0310_i2c_probe(struct i2c_client *client, const struct i2c_device_id *id) { return msm_sensor_i2c_probe(client, id, &gc0310_s_ctrl); } static struct i2c_driver gc0310_i2c_driver = { .id_table = gc0310_i2c_id, .probe = msm_gc0310_i2c_probe, .driver = { .name = GC0310_SENSOR_NAME, }, }; static struct msm_camera_i2c_client gc0310_sensor_i2c_client = { .addr_type = MSM_CAMERA_I2C_BYTE_ADDR, }; static const struct of_device_id gc0310_dt_match[] = { {.compatible = "shinetech,gc0310", .data = &gc0310_s_ctrl}, {} }; MODULE_DEVICE_TABLE(of, gc0310_dt_match); static int32_t gc0310_platform_probe(struct platform_device *pdev) { int32_t rc; const struct of_device_id *match; match = of_match_device(gc0310_dt_match, &pdev->dev); if (!match) return -EFAULT; rc = msm_sensor_platform_probe(pdev, match->data); return rc; } static struct platform_driver gc0310_platform_driver = { .driver = { .name = "shinetech,gc0310", .owner = THIS_MODULE, .of_match_table = gc0310_dt_match, }, .probe = gc0310_platform_probe, }; static int __init gc0310_init_module(void) { int32_t rc; pr_err("%s:%d\n", __func__, __LINE__); rc = i2c_add_driver(&gc0310_i2c_driver); if (!rc) return rc; pr_err("%s:%d rc \n", __func__, __LINE__); return platform_driver_register(&gc0310_platform_driver); } static void __exit gc0310_exit_module(void) { pr_err("%s:%d\n", __func__, __LINE__); if (gc0310_s_ctrl.pdev) { msm_sensor_free_sensor_data(&gc0310_s_ctrl); platform_driver_unregister(&gc0310_platform_driver); } else i2c_del_driver(&gc0310_i2c_driver); return; } int32_t gc0310_sensor_config(struct msm_sensor_ctrl_t *s_ctrl, void __user *argp) { struct sensorb_cfg_data *cdata = (struct sensorb_cfg_data *)argp; long rc = 0; int32_t i = 0; mutex_lock(s_ctrl->msm_sensor_mutex); CDBG("%s:%d %s cfgtype = %d\n", __func__, __LINE__, s_ctrl->sensordata->sensor_name, cdata->cfgtype); switch (cdata->cfgtype) { case CFG_GET_SENSOR_INFO: memcpy(cdata->cfg.sensor_info.sensor_name, s_ctrl->sensordata->sensor_name, sizeof(cdata->cfg.sensor_info.sensor_name)); cdata->cfg.sensor_info.session_id = s_ctrl->sensordata->sensor_info->session_id; for (i = 0; i < SUB_MODULE_MAX; i++) cdata->cfg.sensor_info.subdev_id[i] = s_ctrl->sensordata->sensor_info->subdev_id[i]; cdata->cfg.sensor_info.is_mount_angle_valid = s_ctrl->sensordata->sensor_info->is_mount_angle_valid; cdata->cfg.sensor_info.sensor_mount_angle = s_ctrl->sensordata->sensor_info->sensor_mount_angle; CDBG("%s:%d sensor name %s\n", __func__, __LINE__, cdata->cfg.sensor_info.sensor_name); CDBG("%s:%d session id %d\n", __func__, __LINE__, cdata->cfg.sensor_info.session_id); for (i = 0; i < SUB_MODULE_MAX; i++) CDBG("%s:%d subdev_id[%d] %d\n", __func__, __LINE__, i, cdata->cfg.sensor_info.subdev_id[i]); CDBG("%s:%d mount angle valid %d value %d\n", __func__, __LINE__, cdata->cfg.sensor_info.is_mount_angle_valid, cdata->cfg.sensor_info.sensor_mount_angle); break; case CFG_SET_INIT_SETTING: /* 1. Write Recommend settings */ /* 2. Write change settings */ rc = s_ctrl->sensor_i2c_client->i2c_func_tbl-> i2c_write_table( s_ctrl->sensor_i2c_client, gc0310_recommend_setting); break; case CFG_SET_RESOLUTION: { /*copy from user the desired resoltuion*/ enum msm_sensor_resolution_t res = MSM_SENSOR_INVALID_RES; if (copy_from_user(&res, (void *)cdata->cfg.setting, sizeof(enum msm_sensor_resolution_t))) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } pr_err("%s:%d res =%d\n", __func__, __LINE__, res); if (res == MSM_SENSOR_RES_FULL) { rc = s_ctrl->sensor_i2c_client->i2c_func_tbl-> i2c_write_table( s_ctrl->sensor_i2c_client, gc0310_recommend_setting); pr_err("%s:%d res =%d\n gc0310_recommend_setting ", __func__, __LINE__, res); } else { pr_err("%s:%d failed resoultion set\n", __func__, __LINE__); rc = -EFAULT; } } break; case CFG_SET_STOP_STREAM: rc = s_ctrl->sensor_i2c_client->i2c_func_tbl-> i2c_write_table( s_ctrl->sensor_i2c_client, gc0310_stop_settings); break; case CFG_SET_START_STREAM: rc = s_ctrl->sensor_i2c_client->i2c_func_tbl-> i2c_write_table( s_ctrl->sensor_i2c_client, gc0310_start_settings); break; case CFG_GET_SENSOR_INIT_PARAMS: cdata->cfg.sensor_init_params.modes_supported = s_ctrl->sensordata->sensor_info->modes_supported; cdata->cfg.sensor_init_params.position = s_ctrl->sensordata->sensor_info->position; cdata->cfg.sensor_init_params.sensor_mount_angle = s_ctrl->sensordata->sensor_info->sensor_mount_angle; pr_err("%s:%d init params mode %d pos %d mount %d\n", __func__, __LINE__, cdata->cfg.sensor_init_params.modes_supported, cdata->cfg.sensor_init_params.position, cdata->cfg.sensor_init_params.sensor_mount_angle); break; case CFG_SET_SLAVE_INFO: { struct msm_camera_sensor_slave_info *sensor_slave_info; struct msm_camera_power_ctrl_t *p_ctrl; uint16_t size; int slave_index = 0; sensor_slave_info = kmalloc(sizeof(struct msm_camera_sensor_slave_info) * 1, GFP_KERNEL); if (!sensor_slave_info) { pr_err("%s: failed to alloc mem\n", __func__); rc = -ENOMEM; break; } if (copy_from_user(sensor_slave_info, (void *)cdata->cfg.setting, sizeof(struct msm_camera_sensor_slave_info))) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } /* Update sensor slave address */ if (sensor_slave_info->slave_addr) s_ctrl->sensor_i2c_client->cci_client->sid = sensor_slave_info->slave_addr >> 1; /* Update sensor address type */ s_ctrl->sensor_i2c_client->addr_type = sensor_slave_info->addr_type; /* Update power up / down sequence */ p_ctrl = &s_ctrl->sensordata->power_info; size = sensor_slave_info->power_setting_array.size; if (p_ctrl->power_setting_size < size) { struct msm_sensor_power_setting *tmp; tmp = kmalloc(sizeof(struct msm_sensor_power_setting) * size, GFP_KERNEL); if (!tmp) { pr_err("%s: failed to alloc mem\n", __func__); rc = -ENOMEM; break; } kfree(p_ctrl->power_setting); p_ctrl->power_setting = tmp; } p_ctrl->power_setting_size = size; rc = copy_from_user(p_ctrl->power_setting, (void *) sensor_slave_info->power_setting_array.power_setting, size * sizeof(struct msm_sensor_power_setting)); if (rc) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } for (slave_index = 0; slave_index < p_ctrl->power_setting_size; slave_index++) { CDBG("%s i %d power setting %d %d %ld %d\n", __func__, slave_index, p_ctrl->power_setting[slave_index].seq_type, p_ctrl->power_setting[slave_index].seq_val, p_ctrl->power_setting[slave_index].config_val, p_ctrl->power_setting[slave_index].delay); } break; } case CFG_WRITE_I2C_ARRAY: { struct msm_camera_i2c_reg_setting conf_array; struct msm_camera_i2c_reg_array *reg_setting = NULL; if (copy_from_user(&conf_array, (void *)cdata->cfg.setting, sizeof(struct msm_camera_i2c_reg_setting))) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } if (!conf_array.size || conf_array.size > I2C_REG_DATA_MAX) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } reg_setting = kzalloc(conf_array.size * (sizeof(struct msm_camera_i2c_reg_array)), GFP_KERNEL); if (!reg_setting) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -ENOMEM; break; } if (copy_from_user(reg_setting, (void *)conf_array.reg_setting, conf_array.size * sizeof(struct msm_camera_i2c_reg_array))) { pr_err("%s:%d failed\n", __func__, __LINE__); kfree(reg_setting); rc = -EFAULT; break; } conf_array.reg_setting = reg_setting; rc = s_ctrl->sensor_i2c_client->i2c_func_tbl->i2c_write_table( s_ctrl->sensor_i2c_client, &conf_array); kfree(reg_setting); break; } case CFG_WRITE_I2C_SEQ_ARRAY: { struct msm_camera_i2c_seq_reg_setting conf_array; struct msm_camera_i2c_seq_reg_array *reg_setting = NULL; if (copy_from_user(&conf_array, (void *)cdata->cfg.setting, sizeof(struct msm_camera_i2c_seq_reg_setting))) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } if (!conf_array.size || conf_array.size > I2C_SEQ_REG_DATA_MAX) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } reg_setting = kzalloc(conf_array.size * (sizeof(struct msm_camera_i2c_seq_reg_array)), GFP_KERNEL); if (!reg_setting) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -ENOMEM; break; } if (copy_from_user(reg_setting, (void *)conf_array.reg_setting, conf_array.size * sizeof(struct msm_camera_i2c_seq_reg_array))) { pr_err("%s:%d failed\n", __func__, __LINE__); kfree(reg_setting); rc = -EFAULT; break; } conf_array.reg_setting = reg_setting; rc = s_ctrl->sensor_i2c_client->i2c_func_tbl-> i2c_write_seq_table(s_ctrl->sensor_i2c_client, &conf_array); kfree(reg_setting); break; } case CFG_POWER_UP: if (s_ctrl->func_tbl->sensor_power_up) rc = s_ctrl->func_tbl->sensor_power_up(s_ctrl); else rc = -EFAULT; break; case CFG_POWER_DOWN: if (s_ctrl->func_tbl->sensor_power_down) rc = s_ctrl->func_tbl->sensor_power_down(s_ctrl); else rc = -EFAULT; break; case CFG_SET_STOP_STREAM_SETTING: { struct msm_camera_i2c_reg_setting *stop_setting = &s_ctrl->stop_setting; struct msm_camera_i2c_reg_array *reg_setting = NULL; if (copy_from_user(stop_setting, (void *)cdata->cfg.setting, sizeof(struct msm_camera_i2c_reg_setting))) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } reg_setting = stop_setting->reg_setting; stop_setting->reg_setting = kzalloc(stop_setting->size * (sizeof(struct msm_camera_i2c_reg_array)), GFP_KERNEL); if (!stop_setting->reg_setting) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -ENOMEM; break; } if (copy_from_user(stop_setting->reg_setting, (void *)reg_setting, stop_setting->size * sizeof(struct msm_camera_i2c_reg_array))) { pr_err("%s:%d failed\n", __func__, __LINE__); kfree(stop_setting->reg_setting); stop_setting->reg_setting = NULL; stop_setting->size = 0; rc = -EFAULT; break; } break; } case CFG_SET_STREAM_TYPE: { enum msm_camera_stream_type_t stream_type = MSM_CAMERA_STREAM_INVALID; if (copy_from_user(&stream_type, (void *)cdata->cfg.setting, sizeof(enum msm_camera_stream_type_t))) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } s_ctrl->camera_stream_type = stream_type; break; } case CFG_SET_SATURATION: break; case CFG_SET_CONTRAST: break; case CFG_SET_SHARPNESS: break; case CFG_SET_AUTOFOCUS: /* TO-DO: set the Auto Focus */ pr_debug("%s: Setting Auto Focus", __func__); break; case CFG_CANCEL_AUTOFOCUS: /* TO-DO: Cancel the Auto Focus */ pr_debug("%s: Cancelling Auto Focus", __func__); break; case CFG_SET_ISO: break; case CFG_SET_EXPOSURE_COMPENSATION: break; case CFG_SET_EFFECT: break; case CFG_SET_ANTIBANDING: break; case CFG_SET_BESTSHOT_MODE: break; case CFG_SET_WHITE_BALANCE: break; default: rc = -EFAULT; break; } mutex_unlock(s_ctrl->msm_sensor_mutex); return rc; } #ifdef CONFIG_COMPAT int32_t gc0310_sensor_config32(struct msm_sensor_ctrl_t *s_ctrl, void __user *argp) { struct sensorb_cfg_data32 *cdata = (struct sensorb_cfg_data32 *)argp; long rc = 0; int32_t i = 0; mutex_lock(s_ctrl->msm_sensor_mutex); CDBG("%s:%d %s cfgtype = %d\n", __func__, __LINE__, s_ctrl->sensordata->sensor_name, cdata->cfgtype); switch (cdata->cfgtype) { case CFG_GET_SENSOR_INFO: memcpy(cdata->cfg.sensor_info.sensor_name, s_ctrl->sensordata->sensor_name, sizeof(cdata->cfg.sensor_info.sensor_name)); cdata->cfg.sensor_info.session_id = s_ctrl->sensordata->sensor_info->session_id; for (i = 0; i < SUB_MODULE_MAX; i++) cdata->cfg.sensor_info.subdev_id[i] = s_ctrl->sensordata->sensor_info->subdev_id[i]; cdata->cfg.sensor_info.is_mount_angle_valid = s_ctrl->sensordata->sensor_info->is_mount_angle_valid; cdata->cfg.sensor_info.sensor_mount_angle = s_ctrl->sensordata->sensor_info->sensor_mount_angle; CDBG("%s:%d sensor name %s\n", __func__, __LINE__, cdata->cfg.sensor_info.sensor_name); CDBG("%s:%d session id %d\n", __func__, __LINE__, cdata->cfg.sensor_info.session_id); for (i = 0; i < SUB_MODULE_MAX; i++) CDBG("%s:%d subdev_id[%d] %d\n", __func__, __LINE__, i, cdata->cfg.sensor_info.subdev_id[i]); CDBG("%s:%d mount angle valid %d value %d\n", __func__, __LINE__, cdata->cfg.sensor_info.is_mount_angle_valid, cdata->cfg.sensor_info.sensor_mount_angle); break; case CFG_SET_INIT_SETTING: /* 1. Write Recommend settings */ /* 2. Write change settings */ rc = s_ctrl->sensor_i2c_client->i2c_func_tbl-> i2c_write_table( s_ctrl->sensor_i2c_client, gc0310_recommend_setting); break; case CFG_SET_RESOLUTION: { /*copy from user the desired resoltuion*/ enum msm_sensor_resolution_t res = MSM_SENSOR_INVALID_RES; if (copy_from_user(&res, (void *)cdata->cfg.setting, sizeof(enum msm_sensor_resolution_t))) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } pr_err("%s:%d res =%d\n", __func__, __LINE__, res); if (res == MSM_SENSOR_RES_FULL) { rc = s_ctrl->sensor_i2c_client->i2c_func_tbl-> i2c_write_table( s_ctrl->sensor_i2c_client, gc0310_recommend_setting); pr_err("%s:%d res =%d\n gc0310_recommend_setting ", __func__, __LINE__, res); } else { pr_err("%s:%d failed resoultion set\n", __func__, __LINE__); rc = -EFAULT; } } break; case CFG_SET_STOP_STREAM: rc = s_ctrl->sensor_i2c_client->i2c_func_tbl-> i2c_write_table( s_ctrl->sensor_i2c_client, gc0310_stop_settings); break; case CFG_SET_START_STREAM: rc = s_ctrl->sensor_i2c_client->i2c_func_tbl-> i2c_write_table( s_ctrl->sensor_i2c_client, gc0310_start_settings); break; case CFG_GET_SENSOR_INIT_PARAMS: cdata->cfg.sensor_init_params.modes_supported = s_ctrl->sensordata->sensor_info->modes_supported; cdata->cfg.sensor_init_params.position = s_ctrl->sensordata->sensor_info->position; cdata->cfg.sensor_init_params.sensor_mount_angle = s_ctrl->sensordata->sensor_info->sensor_mount_angle; pr_err("%s:%d init params mode %d pos %d mount %d\n", __func__, __LINE__, cdata->cfg.sensor_init_params.modes_supported, cdata->cfg.sensor_init_params.position, cdata->cfg.sensor_init_params.sensor_mount_angle); break; case CFG_SET_SLAVE_INFO: { struct msm_camera_sensor_slave_info *sensor_slave_info; struct msm_camera_power_ctrl_t *p_ctrl; uint16_t size; int slave_index = 0; sensor_slave_info = kmalloc(sizeof(struct msm_camera_sensor_slave_info) * 1, GFP_KERNEL); if (!sensor_slave_info) { pr_err("%s: failed to alloc mem\n", __func__); rc = -ENOMEM; break; } if (copy_from_user(sensor_slave_info, (void *)cdata->cfg.setting, sizeof(struct msm_camera_sensor_slave_info))) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } /* Update sensor slave address */ if (sensor_slave_info->slave_addr) s_ctrl->sensor_i2c_client->cci_client->sid = sensor_slave_info->slave_addr >> 1; /* Update sensor address type */ s_ctrl->sensor_i2c_client->addr_type = sensor_slave_info->addr_type; /* Update power up / down sequence */ p_ctrl = &s_ctrl->sensordata->power_info; size = sensor_slave_info->power_setting_array.size; if (p_ctrl->power_setting_size < size) { struct msm_sensor_power_setting *tmp; tmp = kmalloc(sizeof(struct msm_sensor_power_setting) * size, GFP_KERNEL); if (!tmp) { pr_err("%s: failed to alloc mem\n", __func__); rc = -ENOMEM; break; } kfree(p_ctrl->power_setting); p_ctrl->power_setting = tmp; } p_ctrl->power_setting_size = size; rc = copy_from_user(p_ctrl->power_setting, (void *) sensor_slave_info->power_setting_array.power_setting, size * sizeof(struct msm_sensor_power_setting)); if (rc) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } for (slave_index = 0; slave_index < p_ctrl->power_setting_size; slave_index++) { CDBG("%s i %d power setting %d %d %ld %d\n", __func__, slave_index, p_ctrl->power_setting[slave_index].seq_type, p_ctrl->power_setting[slave_index].seq_val, p_ctrl->power_setting[slave_index].config_val, p_ctrl->power_setting[slave_index].delay); } break; } case CFG_WRITE_I2C_ARRAY: { struct msm_camera_i2c_reg_setting conf_array; struct msm_camera_i2c_reg_array *reg_setting = NULL; if (copy_from_user(&conf_array, (void *)cdata->cfg.setting, sizeof(struct msm_camera_i2c_reg_setting))) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } if (!conf_array.size || conf_array.size > I2C_REG_DATA_MAX) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } reg_setting = kzalloc(conf_array.size * (sizeof(struct msm_camera_i2c_reg_array)), GFP_KERNEL); if (!reg_setting) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -ENOMEM; break; } if (copy_from_user(reg_setting, (void *)conf_array.reg_setting, conf_array.size * sizeof(struct msm_camera_i2c_reg_array))) { pr_err("%s:%d failed\n", __func__, __LINE__); kfree(reg_setting); rc = -EFAULT; break; } conf_array.reg_setting = reg_setting; rc = s_ctrl->sensor_i2c_client->i2c_func_tbl->i2c_write_table( s_ctrl->sensor_i2c_client, &conf_array); kfree(reg_setting); break; } case CFG_WRITE_I2C_SEQ_ARRAY: { struct msm_camera_i2c_seq_reg_setting conf_array; struct msm_camera_i2c_seq_reg_array *reg_setting = NULL; if (copy_from_user(&conf_array, (void *)cdata->cfg.setting, sizeof(struct msm_camera_i2c_seq_reg_setting))) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } if (!conf_array.size || conf_array.size > I2C_SEQ_REG_DATA_MAX) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } reg_setting = kzalloc(conf_array.size * (sizeof(struct msm_camera_i2c_seq_reg_array)), GFP_KERNEL); if (!reg_setting) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -ENOMEM; break; } if (copy_from_user(reg_setting, (void *)conf_array.reg_setting, conf_array.size * sizeof(struct msm_camera_i2c_seq_reg_array))) { pr_err("%s:%d failed\n", __func__, __LINE__); kfree(reg_setting); rc = -EFAULT; break; } conf_array.reg_setting = reg_setting; rc = s_ctrl->sensor_i2c_client->i2c_func_tbl-> i2c_write_seq_table(s_ctrl->sensor_i2c_client, &conf_array); kfree(reg_setting); break; } case CFG_POWER_UP: if (s_ctrl->func_tbl->sensor_power_up) rc = s_ctrl->func_tbl->sensor_power_up(s_ctrl); else rc = -EFAULT; break; case CFG_POWER_DOWN: if (s_ctrl->func_tbl->sensor_power_down) rc = s_ctrl->func_tbl->sensor_power_down(s_ctrl); else rc = -EFAULT; break; case CFG_SET_STOP_STREAM_SETTING: { struct msm_camera_i2c_reg_setting *stop_setting = &s_ctrl->stop_setting; struct msm_camera_i2c_reg_array *reg_setting = NULL; if (copy_from_user(stop_setting, (void *)cdata->cfg.setting, sizeof(struct msm_camera_i2c_reg_setting))) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } reg_setting = stop_setting->reg_setting; stop_setting->reg_setting = kzalloc(stop_setting->size * (sizeof(struct msm_camera_i2c_reg_array)), GFP_KERNEL); if (!stop_setting->reg_setting) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -ENOMEM; break; } if (copy_from_user(stop_setting->reg_setting, (void *)reg_setting, stop_setting->size * sizeof(struct msm_camera_i2c_reg_array))) { pr_err("%s:%d failed\n", __func__, __LINE__); kfree(stop_setting->reg_setting); stop_setting->reg_setting = NULL; stop_setting->size = 0; rc = -EFAULT; break; } break; } case CFG_SET_STREAM_TYPE: { enum msm_camera_stream_type_t stream_type = MSM_CAMERA_STREAM_INVALID; if (copy_from_user(&stream_type, (void *)cdata->cfg.setting, sizeof(enum msm_camera_stream_type_t))) { pr_err("%s:%d failed\n", __func__, __LINE__); rc = -EFAULT; break; } s_ctrl->camera_stream_type = stream_type; break; } case CFG_SET_SATURATION: break; case CFG_SET_CONTRAST: break; case CFG_SET_SHARPNESS: break; case CFG_SET_AUTOFOCUS: /* TO-DO: set the Auto Focus */ pr_debug("%s: Setting Auto Focus", __func__); break; case CFG_CANCEL_AUTOFOCUS: /* TO-DO: Cancel the Auto Focus */ pr_debug("%s: Cancelling Auto Focus", __func__); break; case CFG_SET_ISO: break; case CFG_SET_EXPOSURE_COMPENSATION: break; case CFG_SET_EFFECT: break; case CFG_SET_ANTIBANDING: break; case CFG_SET_BESTSHOT_MODE: break; case CFG_SET_WHITE_BALANCE: break; default: rc = -EFAULT; break; } mutex_unlock(s_ctrl->msm_sensor_mutex); return rc; } #endif static struct msm_sensor_fn_t gc0310_sensor_func_tbl = { .sensor_config = gc0310_sensor_config, #ifdef CONFIG_COMPAT .sensor_config32 = gc0310_sensor_config32, #endif .sensor_power_up = msm_sensor_power_up, .sensor_power_down = msm_sensor_power_down, .sensor_match_id = msm_sensor_match_id, }; static struct msm_sensor_ctrl_t gc0310_s_ctrl = { .sensor_i2c_client = &gc0310_sensor_i2c_client, .power_setting_array.power_setting = gc0310_power_setting, .power_setting_array.size = ARRAY_SIZE(gc0310_power_setting), .msm_sensor_mutex = &gc0310_mut, .sensor_v4l2_subdev_info = gc0310_subdev_info, .sensor_v4l2_subdev_info_size = ARRAY_SIZE(gc0310_subdev_info), .func_tbl = &gc0310_sensor_func_tbl, }; module_init(gc0310_init_module); module_exit(gc0310_exit_module); MODULE_DESCRIPTION("Aptina 0.3MP YUV sensor driver"); MODULE_LICENSE("GPL v2");