int s5k6aafx13_sensor_release(void)
{
#ifdef CONFIG_PANTECH_CAMERA_TUNER
si2c_pid_t i = 0;
#endif
CDBG("%s E\n", __func__);
mutex_lock(&s5k6aafx13_mutex);
if (s5k6aafx13_ctrl) {
kfree(s5k6aafx13_ctrl);
s5k6aafx13_ctrl = NULL;
}
(void)s5k6aafx13_power_off();
svreg_release(svregs, CAMV_MAX);
sgpio_release(sgpios, CAMIO_MAX);
#ifdef CONFIG_PANTECH_CAMERA_TUNER
for (i = 0; i < SI2C_PID_MAX; i++) {
if (s5k6aafx13_tuner_params[i].cmds)
kfree(s5k6aafx13_tuner_params[i].cmds);
}
#endif
si2c_release();
mutex_unlock(&s5k6aafx13_mutex);
CDBG("%s X\n", __func__);
return 0;
}
//mt9d113_sensor_power_down
int32_t mt9d113_sensor_power_down(struct msm_sensor_ctrl_t *s_ctrl)
{
int32_t rc = 0;
CDBG("%s E\n", __func__);
msm_sensor_power_down(s_ctrl);
CDBG(" %s : msm_sensor_power_down : rc = %d E\n",__func__, rc);
if (sgpio_ctrl(sgpios, CAMIO_F_STB, 0) < 0) rc = -EIO;
if (sgpio_ctrl(sgpios, CAMIO_F_RST_N, 0) < 0) rc = -EIO;
mdelay(1);
/* MCLK will be disabled once again after this. */
// (void)msm_camio_clk_disable(CAMIO_CAM_MCLK_CLK);
if (svreg_ctrl(svregs, CAMV_IO_1P8V, 0) < 0) rc = -EIO;
if (svreg_ctrl(svregs, CAMV_CORE_1P8V, 0) < 0) rc = -EIO;
if (svreg_ctrl(svregs, CAMV_A_2P8V, 0) < 0) rc = -EIO;
mdelay(1);
if (sgpio_ctrl(sgpios, CAMIO_R_RST_N, 0) < 0) rc = -EIO;
if (sgpio_ctrl(sgpios, CAMIO_R_STB_N, 0) < 0) rc = -EIO;
mdelay(1);
svreg_release(svregs, CAMV_MAX);
sgpio_release(sgpios, CAMIO_MAX);
si2c_release();
CDBG("%s X (%d)\n", __func__, rc);
return rc;
}
int mt9d113_sensor_init(struct msm_sensor_ctrl_t *s_ctrl)
{
int rc = 0;
//uint8_t data_buf[4];
SKYCDBG("%s: E\n",__func__);
#if 1//needtocheck
//sensor_mode = ??;//SENSOR_PREVIEW_MODE;
// memset(mt9d113_params, 0, sizeof(mt9d113_params));
//s_ctrl->sensor_i2c_client->client->adapter,
// rc = si2c_init(s5k6aafx13_client->adapter, s5k6aafx13_const_params, s5k6aafx13_params);
#if 0
rc = si2c_init(mt9d113_client->adapter,
mt9d113_const_params, mt9d113_params);
if (!mt9d113_ctrl) {
SKYCDBG("%s err(-ENOMEM)\n", __func__);
goto sensor_init_fail;
}
#endif
rc = si2c_write_param(SI2C_SA, SI2C_INIT, mt9d113_params);
SKYCDBG("%s: si2c_write_param / rc:%d \n",__func__, rc);
if (rc < 0)
goto sensor_init_fail;
#endif
sensor_mode = 1;
SKYCDBG("%s: X\n",__func__);
return rc;
#if 1//needtocheck
sensor_init_fail:
#if 0
if (mt9d113_ctrl) {
kfree(mt9d113_ctrl);
mt9d113_ctrl = NULL;
}
(void)mt9d113_power_off();
svreg_release(svregs, CAMV_MAX);
sgpio_release(sgpios, CAMIO_MAX);
#endif
SKYCDBG("%s: sensor_init_fail / si2c_release(); \n",__func__);
si2c_release();
SKYCDBG("%s err(%d)\n", __func__, rc);
return rc;
#endif
}
int mt9v113_sensor_init(struct msm_sensor_ctrl_t *s_ctrl)
{
int rc = 0;
memset(mt9v113_params, 0, sizeof(mt9v113_params));
rc = si2c_init(s_ctrl->sensor_i2c_client->client->adapter, mt9v113_const_params, mt9v113_params);
if (rc < 0) {
printk("%s err(%d)\n", __func__, rc);
si2c_release();
return rc;
}
rc = si2c_write_param(SI2C_SA, SI2C_INIT, mt9v113_params);
if (rc < 0) {
printk("%s err(%d)\n", __func__, rc);
si2c_release();
return rc;
}
return rc;
}
int s5k6aafx13_sensor_init(const struct msm_camera_sensor_info *sinfo)
{
int rc = 0;
CDBG("%s E\n", __func__);
config_csi_done = false;
sensor_mode = SENSOR_PREVIEW_MODE;
memset(s5k6aafx13_params, 0, sizeof(s5k6aafx13_params));
#ifdef CONFIG_PANTECH_CAMERA_TUNER
memset(s5k6aafx13_tuner_params, 0, sizeof(s5k6aafx13_tuner_params));
#endif
//PANTECH_CAMERA_TODO, adapter 설정과 param 설정을 분리할 것. ugly 하다...
rc = si2c_init(s5k6aafx13_client->adapter,
s5k6aafx13_const_params, s5k6aafx13_params);
if (rc < 0)
goto sensor_init_fail;
s5k6aafx13_ctrl = kzalloc(sizeof(s5k6aafx13_ctrl_t), GFP_KERNEL);
if (!s5k6aafx13_ctrl) {
CERR("%s err(-ENOMEM)\n", __func__);
goto sensor_init_fail;
}
if (sinfo)
s5k6aafx13_ctrl->sinfo = sinfo;
rc = sgpio_init(sgpios, CAMIO_MAX);
if (rc < 0)
goto sensor_init_fail;
rc = svreg_init(svregs, CAMV_MAX);
if (rc < 0)
goto sensor_init_fail;
rc = s5k6aafx13_power_on();
if (rc < 0)
goto sensor_init_fail;
#ifdef CONFIG_PANTECH_CAMERA_TUNER
CERR("%s tuner is enabled, skip writing INIT param!\n", __func__);
#else
rc = si2c_write_param(SI2C_SA, SI2C_INIT, s5k6aafx13_params);
if (rc < 0)
goto sensor_init_fail;
#endif
CDBG("%s X\n", __func__);
return 0;
sensor_init_fail:
if (s5k6aafx13_ctrl) {
kfree(s5k6aafx13_ctrl);
s5k6aafx13_ctrl = NULL;
}
(void)s5k6aafx13_power_off();
svreg_release(svregs, CAMV_MAX);
sgpio_release(sgpios, CAMIO_MAX);
si2c_release();
CERR("%s err(%d)\n", __func__, rc);
return rc;
}
