int rt5648_update_eqmode(
struct snd_soc_codec *codec, int channel, int mode)
{
struct rt_codec_ops *ioctl_ops = rt_codec_get_ioctl_ops();
int i, upd_reg, reg, mask;
hweq_t *proj_hweq_param;
if (codec == NULL || mode >= RT5648_HWEQ_LEN) {
pr_err("%s : return error, mode = %d\n", __func__, mode);
return -EINVAL;
}
pr_debug("%s(): mode=%d\n", __func__, mode);
PROJ_ID = Read_PROJ_ID();
if (PROJ_ID == PROJ_ID_FE380CG || PROJ_ID == PROJ_ID_FE380CXG)
proj_hweq_param = FE380CG_hweq_param;
else if (PROJ_ID == PROJ_ID_Z580C || PROJ_ID == PROJ_ID_Z580CA)
proj_hweq_param = Z580C_hweq_param;
else if (PROJ_ID == PROJ_ID_FE171MG)
proj_hweq_param = FE171MG_hweq_param;
for (i = 0; i < EQ_REG_NUM; i++) {
proj_hweq_param[mode].reg[i] = eqreg[channel][i];
}
for (i = 0; i < EQ_REG_NUM; i++) {
if (proj_hweq_param[mode].reg[i]) {
ioctl_ops->index_write(codec, proj_hweq_param[mode].reg[i],
proj_hweq_param[mode].value[i]);
} else {
break;
}
}
switch (channel) {
case EQ_CH_DAC:
reg = RT5648_EQ_CTRL2;
mask = 0x33fe;
upd_reg = RT5648_EQ_CTRL1;
break;
case EQ_CH_ADC:
reg = RT5648_ADC_EQ_CTRL2;
mask = 0x01bf;
upd_reg = RT5648_ADC_EQ_CTRL1;
break;
default:
printk(KERN_ERR "Invalid EQ channel\n");
return -EINVAL;
}
snd_soc_update_bits(codec, reg, mask, proj_hweq_param[mode].ctrl);
snd_soc_update_bits(codec, upd_reg,
RT5648_EQ_UPD, RT5648_EQ_UPD);
snd_soc_update_bits(codec, upd_reg, RT5648_EQ_UPD, 0);
return 0;
}
static int asus_led_probe(struct i2c_client *client,
const struct i2c_device_id *id)
{
struct led_platform_data *pdata;
struct led_info_priv *priv;
struct i2c_adapter *adapter;
int i, ret = 0;
LED_INFO("%s +++\n", __func__);
/* check if the project support TCA6507 */
if (Read_PROJ_ID()==PROJ_ID_ZS550ML_SEC) {
LED_INFO("this project doesn't support tca6507, skip probe function.\n");
return 0;
}
adapter = to_i2c_adapter(client->dev.parent);
if (!i2c_check_functionality(adapter, I2C_FUNC_I2C))
return -EIO;
pdata = client->dev.platform_data;
if (pdata && pdata->num_leds) {
priv = kzalloc(sizeof_led_info_priv(pdata->num_leds),
GFP_KERNEL);
if (!priv)
return -ENOMEM;
priv->num_leds = pdata->num_leds;
for (i = 0; i < priv->num_leds; i++) {
priv->leds[i].cdev.name = pdata->leds[i].name;
priv->leds[i].cdev.brightness_set = asus_led_set_brightness;
priv->leds[i].cdev.brightness = LED_OFF;
priv->leds[i].cdev.max_brightness = 255;
ret = led_classdev_register(&client->dev, &priv->leds[i].cdev);
if (ret < 0)
LED_ERR("led_classdev_register led[%d] fail\n", i);
#ifdef CONTROL_LED
disable_led_flag = 0;
ret = device_create_file(priv->leds[i].cdev.dev, &dev_attr_disable);
if (ret)
LED_ERR("device_create_file disable in led[%d] fail\n", i);
#endif
red_led_flag = 0;
green_led_flag = 0;
red_blink_flag = 0;
green_blink_flag = 0;
ret = device_create_file(priv->leds[i].cdev.dev, &dev_attr_blink);
if (ret)
LED_ERR("device_create_file blink in led[%d] fail\n", i);
}
}
led_client = client;
LED_INFO("%s ---\n", __func__);
return 0;
}
static int intel_kpd_led_rpmsg_probe(struct rpmsg_channel *rpdev)
{
int ret;
int ret2;
uint8_t data_led;
dev_info(&rpdev->dev, "Probed kpd_led rpmsg device\n");
HW_ID = Read_HW_ID();
PROJ_ID = Read_PROJ_ID();
LED_for_old_HW = (PROJ_ID == PROJ_ID_PF400CG && HW_ID == 2) ||
(PROJ_ID == PROJ_ID_A400CG && (HW_ID == 0 || HW_ID == 4));
LED_for_new_HW = (PROJ_ID == PROJ_ID_PF400CG && (HW_ID == 6 || HW_ID == 1)) ||
(PROJ_ID == PROJ_ID_A400CG && (HW_ID != 0 && HW_ID != 4 ));
ret = led_classdev_register(&rpdev->dev, &intel_led);
if (ret) {
dev_err(&rpdev->dev, "register led dev failed");
return ret;
}
ret = led_classdev_register(&rpdev->dev, &red_led);
if (ret) {
dev_err(&rpdev->dev, "register led dev failed");
return ret;
}
ret = intel_scu_ipc_iowrite8(PWM1_DUT_CYC_ER, 0x00);
ret = intel_scu_ipc_iowrite8(PWM2_DUT_CYC_ER, 0x00);
if(LED_for_old_HW || LED_for_new_HW){//PF400CG ER2:2, PR:6, MP:1
printk("[LED]: The HW_ID = %d \n",HW_ID);
ret = gpio_request_one(LED_RED_GPIO, GPIOF_OUT_INIT_LOW, "RED_LED");
ret = gpio_request_one(LED_GREEN_GPIO, GPIOF_OUT_INIT_LOW, "GREEN_LED");
}
led_update = true;
intel_led_set(&intel_led, intel_led.brightness);
#ifdef CONFIG_EEPROM_PADSTATION
register_microp_notifier(&led_notifier);
#endif
//register_early_suspend(&intel_kpd_led_suspend_desc);
return 0;
}
/* * Checking the SOC type is temporary workaround to enable OV5670 * on Bodegabay (tangier) platform. Once standard regulator devices * (e.g. vprog2, vprog1) and control functions (pmic_avp) are added * for the platforms with tangier, then we can revert this change. * ([email protected]) */ static int ov5670_platform_init(struct i2c_client *client) { pr_info("%s()\n", __func__); if (PROJECT_ID == 0xFF) { PROJECT_ID = Read_PROJ_ID(); } pr_info("%s(%d):Project ID = %d\n", __func__, __LINE__, PROJECT_ID); if (HW_ID == 0xFF) { HW_ID = Read_HW_ID(); } pr_info("%s(%d):HW ID = %d\n", __func__, __LINE__, HW_ID); if (PCB_ID == 0xFF) { PCB_ID = Read_PCB_ID(); pr_info("%s(%d):PCB ID = %x\n", __func__, __LINE__, PCB_ID); switch (PROJECT_ID) { case PROJ_ID_Z580C: project_id = PCB_ID & 0x7; hardware_id = (PCB_ID & 0x38) >> 3; offset_0 = (PCB_ID & 0x40) >> 6; offset_1 = (PCB_ID & 0x80) >> 7; offset_2 = (PCB_ID & 0x700) >> 8; offset_3 = (PCB_ID & 0x1800) >> 11; offset_4 = (PCB_ID & 0x2000) >> 13; //offset_0: Panel ID, offset_1: Wifi ID, offset_2: RF ID, offset_3: Main Camera ID, offset_4: Sub Camera ID //PCB_ID = pentry->project_id | pentry->hardware_id << 3 | pentry->offset_0 << 6 | pentry->offset_1 << 7 | pentry->offset_2 << 8 | pentry->offset_3 << 11 | pentry->offset_4 << 13; pr_info("%s: project id = %d, hardware id = %d, offset_0 = %d, offset_1 = %d, offset_2 = %d, offset_3 = %d, offset_4 = %d\n", __func__, project_id, hardware_id, offset_0, offset_1, offset_2, offset_3, offset_4); break; default: break; } }
/*
* The camera_v1p8_en gpio pin is to enable 1.8v power.
*/
static int ov5670_power_ctrl(struct v4l2_subdev *sd, int flag)
{
int ret = 0;
printk("@%s PROJECT_ID = 0x%x, HW_ID = 0x%x\n", __func__, Read_PROJ_ID(), Read_HW_ID());
if (camera_1p2_en < 0) {
ret = camera_sensor_gpio(-1,"INT_CAM_1V2_EN", GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("camera_1p2_en not available.\n");
return ret;
}
camera_1p2_en = ret;
printk(KERN_INFO "ov5670, gpio number, camera_1p2_en is %d\n", camera_1p2_en);
}
if (camera_2v8 < 0) {
ret = camera_sensor_gpio(-1, "INT_CAM_2V8_EN", GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("INT_CAM_2V8_EN not available.\n");
return ret;
}
camera_2v8 = ret;
printk("<< camera_2v8:%d, flag:%d\n", camera_2v8, flag);
}
if (flag) {
switch (Read_PROJ_ID()) {
case PROJ_ID_ZE550ML:
case PROJ_ID_ZE551ML:
case PROJ_ID_ZR550ML:
case PROJ_ID_ZX550ML:
switch (Read_HW_ID()) {
case HW_ID_EVB:
pr_info("Hardware VERSION = EVB, ov5670 does not support.\n");
break;
case HW_ID_SR1:
case HW_ID_SR2:
case HW_ID_ER:
case HW_ID_ER1_1:
case HW_ID_ER1_2:
case HW_ID_PR:
case HW_ID_pre_PR:
case HW_ID_MP:
pr_info("ov5670 --> HW_ID = 0x%x\n", Read_HW_ID());
//turn on power 2.8V
if (camera_2v8 >= 0){
gpio_set_value(camera_2v8, 1);
printk(KERN_ALERT "ov5670 <<< camera_2v8 = 1\n");
}
//turn on power 1.8V
if (!camera_vprog2_on) {
camera_vprog2_on = 1;
ret = intel_scu_ipc_iowrite8(MSIC_VPROG2_MRFLD_CTRL, MSIC_VPROG2_ON_1P8);
if (ret){
printk(KERN_INFO "set vprog2 fails\n");
return -1;
}
msleep(1);
}
break;
default:
pr_info("ov5670 --> HW_ID 0x%x is not defined\n", Read_HW_ID());
break;
}
break;
case PROJ_ID_ZE500ML:
switch (Read_HW_ID()) {
case HW_ID_EVB:
pr_info("ov5670 --> HW_ID = 0x%x\n", Read_HW_ID());
//turn on power 1.8V
if (!camera_vprog2_on) {
camera_vprog2_on = 1;
ret = intel_scu_ipc_iowrite8(MSIC_VPROG2_MRFLD_CTRL, MSIC_VPROG2_ON_1P8);
if (ret){
printk(KERN_INFO "set vprog2 fails\n");
return -1;
}
msleep(1);
}
//turn on power 2.8V
if (!camera_vprog1_on) {
camera_vprog1_on = 1;
intel_scu_ipc_iowrite8(MSIC_VPROG1_MRFLD_CTRL ,MSIC_VPROG1_ON_2P8);
if (ret){
printk(KERN_INFO "set vprog1 fails\n");
return -1;
}
msleep(1);
}
break;
case HW_ID_SR1:
case HW_ID_SR2:
case HW_ID_ER:
case HW_ID_pre_PR:
case HW_ID_PR:
case HW_ID_MP:
pr_info("HW_ID 0x%x, ov5670 does not support.\n", Read_HW_ID());
break;
default:
pr_info("ov5670 --> HW_ID 0x%x is not defined\n", Read_HW_ID());
break;
}
break;
default:
pr_info("Project ID is not defined\n");
break;
}//end switch
//turn on power 1.2V
gpio_set_value(camera_1p2_en, 1);
printk(KERN_INFO "ov5670---camera_1p2_en is %d\n", camera_1p2_en);
usleep_range(10000, 11000);
//flag == 0
} else {
//turn OFF power 1.2V
gpio_set_value(camera_1p2_en, 0);
gpio_free(camera_1p2_en);
camera_1p2_en = -1;
switch (Read_PROJ_ID()) {
case PROJ_ID_ZE550ML:
case PROJ_ID_ZE551ML:
case PROJ_ID_ZR550ML:
case PROJ_ID_ZX550ML:
switch (Read_HW_ID()) {
case HW_ID_EVB:
pr_info("Hardware VERSION = EVB, ov5670 does not support.\n");
break;
case HW_ID_SR1:
case HW_ID_SR2:
case HW_ID_ER:
case HW_ID_ER1_1:
case HW_ID_ER1_2:
case HW_ID_PR:
case HW_ID_pre_PR:
case HW_ID_MP:
pr_info("ov5670 --> HW_ID = 0x%x\n", Read_HW_ID());
//turn off power 2.8V
if (camera_2v8 >= 0){
gpio_set_value(camera_2v8, 0);
gpio_free(camera_2v8);
camera_2v8 = -1;
printk("<<< camera_2v8 = 0\n");
}
break;
default:
pr_info("ov5670 --> HW_ID is not defined\n");
break;
}
break;
case PROJ_ID_ZE500ML:
switch (Read_HW_ID()) {
case HW_ID_EVB:
pr_info("ov5670 --> HW_ID = 0x%x\n", Read_HW_ID());
//turn off power 2.8V
if (camera_vprog1_on) {
camera_vprog1_on = 0;
ret = intel_scu_ipc_iowrite8(MSIC_VPROG1_MRFLD_CTRL, MSIC_VPROG1_OFF);
if (ret) {
printk(KERN_ALERT "Failed to disable regulator vprog1\n");
return ret;
}
printk("<<< 2.8V = 0\n");
}
break;
case HW_ID_SR1:
case HW_ID_SR2:
case HW_ID_ER:
case HW_ID_PR:
case HW_ID_pre_PR:
case HW_ID_MP:
pr_info("HW_ID 0x%x, ov5670 does not support.\n", Read_HW_ID());
break;
default:
pr_info("ov5670 --> HW_ID is not defined\n");
break;
}
break;
default:
pr_info("Project ID is not defined\n");
break;
}//end switch
//turn off power 1.8V
if (camera_vprog2_on) {
camera_vprog2_on = 0;
ret = intel_scu_ipc_iowrite8(MSIC_VPROG2_MRFLD_CTRL, MSIC_VPROG2_OFF);
if (ret) {
printk(KERN_ALERT "Failed to disable regulator vprog2\n");
return ret;
}
printk("<<< 1.8V= 0\n");
}
}//end if
return 0;
}
static int m10mo_power_ctrl(struct v4l2_subdev *sd, int flag)
{
int ret = 0;
pr_info("M10MO power control. flag=%d\n", flag);
if(Read_PROJ_ID() != PROJ_ID_ZX550ML){
pr_err("M10MO, this is not ZX550ML, break! \n");
return -1;
}
set_flis_value(0x3221, 0x2D18);
#ifdef CONFIG_CRYSTAL_COVE
if (flag) {
ret = intel_mid_pmic_writeb(VPROG_2P8V, VPROG_ENABLE);
if (ret) {
pr_err("Failed to power on V2P8SX.\n");
return ret;
}
ret = intel_mid_pmic_writeb(VPROG_1P2V, VPROG_ENABLE);
if (ret) {
pr_err("Failed to power on V1P2SX.\n");
/* Turn all powers off if one is failed. */
intel_mid_pmic_writeb(VPROG_2P8V, VPROG_DISABLE);
return ret;
}
/* Wait for 8ms to make all the power supplies to be stable. */
usleep_range(8000, 8000);
} else {
/* Turn all powers off even when some are failed. */
if (intel_mid_pmic_writeb(VPROG_2P8V, VPROG_DISABLE))
pr_err("Failed to power off V2P8SX.\n");
if (intel_mid_pmic_writeb(VPROG_1P2V, VPROG_DISABLE))
pr_err("Failed to power off V1P2SX.\n");
}
#else
if (camera_1p2_en < 0) {
lnw_gpio_set_alt(55, LNW_GPIO);
ret = camera_sensor_gpio(55,"INT_CAM_1V2_EN", GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("camera_1p2_en is not available.\n");
return ret;
}
camera_1p2_en = ret;
printk(KERN_INFO "M10MO, gpio number, camera_1p2_en is %d\n", camera_1p2_en);
}
switch (Read_HW_ID()) {
case HW_ID_EVB:
case HW_ID_SR1:
case HW_ID_SR2:
case HW_ID_ER:
case HW_ID_ER1_1:
case HW_ID_ER1_2:
case HW_ID_PR:
case HW_ID_pre_PR:
case HW_ID_MP:
if (camera_3p3_en2 < 0) {
gpio_free(58);/////// temp WA.
lnw_gpio_set_alt(58, LNW_GPIO);
ret = camera_sensor_gpio(58, "3X_I2C_LED", GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("GPIO58 is not available.\n");
}else{
camera_3p3_en2 = ret;
printk(KERN_INFO "M10MO, gpio number, camera_3p3_en2 is %d\n", camera_3p3_en2);
}
}
break;
default:
if (camera_3p3_en2 < 0) {
gpio_free(54);/////// temp WA.
lnw_gpio_set_alt(54, LNW_GPIO);
ret = camera_sensor_gpio(54, "3X_I2C_LED", GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("GPIO54 is not available.\n");
}else{
camera_3p3_en2 = ret;
printk(KERN_INFO "M10MO, gpio number, camera_3p3_en2 is %d\n", camera_3p3_en2);
}
}
break;
}//switch
if (camera_2p8_en < 0) {
lnw_gpio_set_alt(56, LNW_GPIO);
ret = camera_sensor_gpio(56,"INT_CAM_2V8_EN", GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("camera_2p8_en not available.\n");
return ret;
}
camera_2p8_en = ret;
printk(KERN_INFO "M10MO, gpio number, camera_2p8_en is %d\n", camera_2p8_en);
}
if (flag) {
/*
static int camera_1p2_en = -1;
static int camera_2p8_en = -1;
static int camera_isp_1p2_en = -1;
*/
if(camera_1p2_en > 0){
printk("@%s %d, project zx550ml pull up GPIO%d\n", __func__, __LINE__, camera_1p2_en);
gpio_set_value(camera_1p2_en, 1);
}
#if 0
ret = intel_scu_ipc_iowrite8(MSIC_VPROG2_MRFLD_CTRL, MSIC_VPROG2_ON_1P8);
if (ret) {
pr_err("Failed to power on M10MO MSIC_VPROG2_ON_1P8.\n");
return ret;
}
#endif
if(camera_3p3_en2 > 0){
mdelay(1);
printk("@%s %d, project zx550ml pull up GPIO%d\n", __func__, __LINE__, camera_3p3_en2);
gpio_set_value(camera_3p3_en2, 1);
}
mdelay(1);
ret = intel_scu_ipc_iowrite8(MSIC_VPROG1_MRFLD_CTRL, MSIC_VPROG1_ON_1P8);
if (ret) {
pr_err("Failed to power on M10MO MSIC_VPROG1_ON_1P8.\n");
return ret;
}else{
printk("@%s %d, project zx550ml pull up Vprog1, 1.8V \n", __func__, __LINE__);
}
if(camera_2p8_en > 0){
printk("@%s %d, project zx550ml pull up GPIO%d\n", __func__, __LINE__, camera_2p8_en);
gpio_set_value(camera_2p8_en, 1);
}
/* Wait for 8ms to make all the power supplies to be stable. */
usleep_range(8000, 8000);
} else {
/*
static int camera_1p2_en = -1;
static int camera_2p8_en = -1;
static int camera_isp_1p2_en = -1;
*/
ret = intel_scu_ipc_iowrite8(MSIC_VPROG1_MRFLD_CTRL, MSIC_VPROG1_OFF);
if (ret) {
pr_err("Failed to power off M10MO MSIC_VPROG1_ON_2P8.\n");
return ret;
}
gpio_set_value(camera_2p8_en, 0);
camera_sensor_gpio_free(camera_2p8_en);
camera_2p8_en = -1;
gpio_set_value(camera_1p2_en, 0);
camera_sensor_gpio_free(camera_1p2_en);
camera_1p2_en = -1;
gpio_set_value(camera_3p3_en2, 0);
camera_sensor_gpio_free(camera_3p3_en2);
camera_3p3_en2 = -1;
camera_sensor_gpio_free(camera_reset);
camera_reset = -1;
}
#endif
return ret;
}
static int mt9m114_power_ctrl(struct v4l2_subdev *sd, int flag)
{
int reg_err;
int ret, SPI_ret=0;
printk("%s: ++\n",__func__);
if (HW_ID == 0xFF){
HW_ID = Read_HW_ID();
}
if (PROJECT_ID == 0xFF) {
PROJECT_ID = Read_PROJ_ID();
}
if (PROJECT_ID==PROJ_ID_ME302C) {
switch (HW_ID) {
case HW_ID_SR1:
case HW_ID_SR2:
case HW_ID_ER:
SPI_ENABLE=0;
break;
case HW_ID_PR:
case HW_ID_MP:
SPI_ENABLE=1;
break;
default:
SPI_ENABLE=1;
}
}
if (PROJECT_ID==PROJ_ID_ME372CG) {
switch (HW_ID) {
case HW_ID_SR1: //for EVB
SPI_ENABLE=0;
break;
case HW_ID_SR2: //for SR1
case HW_ID_ER:
case HW_ID_PR:
case HW_ID_MP:
SPI_ENABLE=1;
break;
default:
SPI_ENABLE=1;
}
}
if (PROJECT_ID==PROJ_ID_ME372C) {
switch (HW_ID) {
case HW_ID_SR1: //for EVB
SPI_ENABLE=0;
break;
case HW_ID_SR2: //for SR1
case HW_ID_ER:
case HW_ID_PR:
case HW_ID_MP:
SPI_ENABLE=1;
break;
default:
SPI_ENABLE=1;
}
}
if (PROJECT_ID==PROJ_ID_GEMINI) {
switch (HW_ID) {
case HW_ID_SR1:
SPI_ENABLE=0;
break;
case HW_ID_SR2:
case HW_ID_ER:
case HW_ID_PR:
case HW_ID_MP:
SPI_ENABLE=1;
break;
default:
SPI_ENABLE=1;
}
}
SPI_ret=spi_init_extra_parameter();
if (SPI_ret==SPI_magic_number) {
SPI_ENABLE=1;
} else if (SPI_ret==EEPROM_magic_number) {
SPI_ENABLE=0;
}
//printk("HW ID:%d\n", HW_ID);
switch (HW_ID){
case HW_ID_SR1:
case HW_ID_SR2:
if (camera_power_1p2_en < 0) {
ret = camera_sensor_gpio(-1, GP_CAMERA_ISP_POWER_1P2_EN,
GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("%s not available.\n", GP_CAMERA_ISP_POWER_1P2_EN);
return ret;
}
camera_power_1p2_en = ret;
}
if (camera_reset < 0) {
ret = camera_sensor_gpio(-1, GP_CAMERA_ISP_RESET,
GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("%s not available.\n", GP_CAMERA_ISP_RESET);
return ret;
}
camera_reset = ret;
}
if (camera_suspend < 0) {
ret = camera_sensor_gpio(-1, GP_CAMERA_ISP_SUSPEND,
GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("%s not available.\n", GP_CAMERA_ISP_SUSPEND);
return ret;
}
camera_suspend = ret;
}
break;
case HW_ID_ER:
case HW_ID_PR:
case HW_ID_MP:
default:
printk("@@@@@HW_ID is unknow:%d, use SR2 setting\n", HW_ID);
if (camera_power_1p2_en < 0) {
ret = camera_sensor_gpio(111, GP_CAMERA_ISP_POWER_1P2_EN,
GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("%s not available.\n", GP_CAMERA_ISP_POWER_1P2_EN);
return ret;
}
camera_power_1p2_en = 111;
}
if (camera_reset < 0) {
ret = camera_sensor_gpio(161, GP_CAMERA_ISP_RESET,
GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("%s not available.\n", GP_CAMERA_ISP_RESET);
return ret;
}
camera_reset = 161;
}
if (camera_suspend < 0) {
ret = camera_sensor_gpio(162, GP_CAMERA_ISP_SUSPEND,
GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("%s not available.\n", GP_CAMERA_ISP_SUSPEND);
return ret;
}
camera_suspend = 162;
}
break;
}
printk("<<1p2_en:%d, reset:%d, suspend:%d, flag:%d\n", camera_power_1p2_en, camera_reset, camera_suspend, flag);
if (flag){
//pull low reset first
if (camera_reset >= 0){
gpio_set_value(camera_reset, 0);
printk("<<< camera_reset = 0\n");
msleep(1);
}
//turn on DVDD power 1.2V
if (camera_power_1p2_en >= 0){
gpio_set_value(camera_power_1p2_en, 1);
printk("<<< DVDD 1.2V = 1\n");
msleep(1);
}
//turn on power VDD_SEN VDD_HOST 1.8V
if (!camera_vprog1_on) {
camera_vprog1_on = 1;
reg_err = regulator_enable(vprog1_reg);
if (reg_err) {
printk(KERN_ALERT "Failed to enable regulator vprog1\n");
return reg_err;
}
printk("<<< VDD_SEN VDD_HOST 1.8V = 1\n");
msleep(10);
}
//turn on power AVDD 2.8V
if (!camera_vprog2_on) {
camera_vprog2_on = 1;
reg_err = regulator_enable(vprog2_reg);
if (reg_err) {
printk(KERN_ALERT "Failed to enable regulator vprog2\n");
return reg_err;
}
printk("<<< AVDD 2.8V = 1\n");
msleep(10);
}
//turn on MCLK
mt9m114_flisclk_ctrl(sd, 1);
msleep(1); //need wait 16 clk cycle
//FW_BSP++
if (SPI_ENABLE==0) {
//Pull high suspend to load fw from SPI
if (camera_suspend >= 0){
gpio_set_value(camera_suspend, 1);
printk("<<< suspend = 1, load fw\n");
}
//Reset control
if (camera_reset >= 0){
gpio_set_value(camera_reset, 1);
printk("<<< reset = 1\n");
msleep(6); //wait 6ms
}
} else {
//Pull low suspend to load fw from host
if (camera_suspend >= 0){
gpio_set_value(camera_suspend, 0);
printk("<<< suspend = 0, load fw\n");
}
lnw_gpio_set_alt(GP_AON_019, LNW_GPIO);
lnw_gpio_set_alt(GP_AON_021, LNW_GPIO);
lnw_gpio_set_alt(GP_AON_023, LNW_GPIO);
if (camera_SPI_1_SS3 < 0) {
ret = camera_sensor_gpio(GP_AON_019, GP_CAMERA_SPI_SS3,
GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("%s not available.\n", GP_CAMERA_SPI_SS3);
return ret;
}
camera_SPI_1_SS3= GP_AON_019;
}
if (camera_SPI_1_SDO < 0) {
ret = camera_sensor_gpio(GP_AON_021, GP_CAMERA_SPI_SDO,
GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("%s not available.\n", GP_CAMERA_SPI_SDO);
return ret;
}
camera_SPI_1_SDO= GP_AON_021;
}
if (camera_SPI_1_CLK < 0) {
ret = camera_sensor_gpio(GP_AON_023, GP_CAMERA_SPI_CLK,
GPIOF_DIR_OUT, 1);
if (ret < 0){
printk("%s not available.\n", GP_CAMERA_SPI_CLK);
return ret;
}
camera_SPI_1_CLK = GP_AON_023;
}
if (camera_SPI_1_SS3 >= 0){
gpio_set_value(camera_SPI_1_SS3, 0);
printk("<<< SPI SS3 = 0\n");
}
if (camera_SPI_1_SDO >= 0){
gpio_set_value(camera_SPI_1_SDO, 0);
printk("<<< SPI SDO = 0\n");
}
if (camera_SPI_1_CLK >= 0){
gpio_set_value(camera_SPI_1_CLK, 1);
printk("<<< SPI CLK = 1\n");
msleep(6);
}
//Reset control
if (camera_reset >= 0){
gpio_set_value(camera_reset, 1);
printk("<<< reset = 1\n");
msleep(6); //wait 6ms
}
if (camera_SPI_1_SS3 >= 0){
gpio_free(camera_SPI_1_SS3);
camera_SPI_1_SS3 = -1;
}
if (camera_SPI_1_SDO >= 0){
gpio_free(camera_SPI_1_SDO);
camera_SPI_1_SDO = -1;
}
if (camera_SPI_1_CLK >= 0){
gpio_set_value(camera_SPI_1_CLK, 0);
printk("<<< SPI CLK = 0\n");
gpio_free(camera_SPI_1_CLK);
camera_SPI_1_CLK = -1;
}
lnw_gpio_set_alt(GP_AON_019, LNW_ALT_1);
lnw_gpio_set_alt(GP_AON_021, LNW_ALT_1);
lnw_gpio_set_alt(GP_AON_023, LNW_ALT_1);
}
//FW_BSP--
//Pull low suspend
if (camera_suspend >= 0){
gpio_set_value(camera_suspend, 0);
printk("<<< suspend = 0\n");
}
msleep(10); //delay time for first i2c command
}else{
//pull low reset
if (camera_reset >= 0){
gpio_set_value(camera_reset, 0);
printk("<<< reset = 0\n");
gpio_free(camera_reset);
camera_reset = -1;
}
//turn off MCLK
mt9m114_flisclk_ctrl(sd, 0);
//turn off power AVDD 2.8V
if (camera_vprog2_on) {
camera_vprog2_on = 0;
reg_err = regulator_disable(vprog2_reg);
if (reg_err) {
printk(KERN_ALERT "Failed to disable regulator vprog2\n");
return reg_err;
}
printk("<<< AVDD 2.8V = 0\n");
msleep(10);
}
lnw_gpio_set_alt(GP_AON_019, LNW_GPIO);
lnw_gpio_set_alt(GP_AON_021, LNW_GPIO);
if (camera_SPI_1_SS3 < 0) {
ret = camera_sensor_gpio(GP_AON_019, GP_CAMERA_SPI_SS3,
GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("%s not available.\n", GP_CAMERA_SPI_SS3);
return ret;
}
camera_SPI_1_SS3= GP_AON_019;
}
if (camera_SPI_1_SDO < 0) {
ret = camera_sensor_gpio(GP_AON_021, GP_CAMERA_SPI_SDO,
GPIOF_DIR_OUT, 0);
if (ret < 0){
printk("%s not available.\n", GP_CAMERA_SPI_SDO);
return ret;
}
camera_SPI_1_SDO= GP_AON_021;
}
if (camera_SPI_1_SS3 >= 0){
gpio_set_value(camera_SPI_1_SS3, 0);
printk("<<< SPI SS3 = 0\n");
gpio_free(camera_SPI_1_SS3);
camera_SPI_1_SS3 = -1;
mdelay(1);
}
if (camera_SPI_1_SDO >= 0){
gpio_set_value(camera_SPI_1_SDO, 0);
printk("<<< SPI SDO = 0\n");
gpio_free(camera_SPI_1_SDO);
camera_SPI_1_SDO = -1;
mdelay(1);
}
//turn off power VDD_SEN VDD_HOST 1.8V
if (camera_vprog1_on) {
camera_vprog1_on = 0;
reg_err = regulator_disable(vprog1_reg);
if (reg_err) {
printk(KERN_ALERT "Failed to disable regulator vprog1\n");
return reg_err;
}
printk("<<< VDD_SEN VDD_HOST 1.8V = 0\n");
msleep(10);
}
//turn off DVDD power 1.2V
if (camera_power_1p2_en >= 0){
gpio_set_value(camera_power_1p2_en, 0);
printk("<<< DVDD 1.2V = 0\n");
gpio_free(camera_power_1p2_en);
camera_power_1p2_en = -1;
}
msleep(1);
//release suspend gpio
if (camera_suspend >= 0){
printk("<<< Release camera_suspend pin:%d\n", camera_suspend);
gpio_free(camera_suspend);
camera_suspend = -1;
}
}
return 0;
}
void otm1284a_vid_init(struct drm_device *dev, struct panel_funcs *p_funcs)
{
int ret = 0;
printk("[DISP] %s\n", __func__);
p_funcs->get_config_mode = otm1284a_vid_get_config_mode;
p_funcs->get_panel_info = otm1284a_vid_get_panel_info;
p_funcs->dsi_controller_init = otm1284a_vid_dsi_controller_init;
p_funcs->detect = otm1284a_vid_detect;
p_funcs->power_on = otm1284a_vid_power_on;
p_funcs->drv_ic_init = otm1284a_vid_drv_ic_init;
p_funcs->power_off = otm1284a_vid_power_off;
p_funcs->reset = otm1284a_vid_reset;
p_funcs->set_brightness = otm1284a_vid_set_brightness;
printk("[DISP] Orise reset workqueue init!\n");
INIT_DELAYED_WORK(&orise1284a_panel_reset_delay_work, orise1284a_vid_panel_reset_delay_work);
orise1284a_panel_reset_delay_wq = create_workqueue("orise1284a_panel_reset_delay_timer");
if (unlikely(!orise1284a_panel_reset_delay_wq)) {
printk("%s : unable to create Panel reset workqueue\n", __func__);
}
#ifdef OTM1284A_DEBUG
sysfs_create_group(&dev->dev->kobj, &otm1284a_attr_group);
#endif
if (Read_HW_ID() == HW_ID_EVB)
lcd_id = ZE500ML_HSD;
else if (Read_PROJ_ID() == PROJ_ID_ZE500ML) {
if (Read_LCD_ID() == ZE500ML_LCD_ID_HSD)
lcd_id = ZE500ML_HSD;
else if (Read_LCD_ID() == ZE500ML_LCD_ID_CTP)
lcd_id = ZE500ML_CTP;
else if (Read_LCD_ID() == ZE500ML_LCD_ID_TM)
lcd_id = ZE500ML_TM;
} else if (Read_PROJ_ID() == PROJ_ID_ZE550ML) {
if (Read_LCD_ID() == ZE550ML_LCD_ID_OTM_TM) {
switch(Read_HW_ID()) {
case HW_ID_SR1:
case HW_ID_SR2:
lcd_id = ZE550ML_TM_SR;
break;
case HW_ID_ER:
case HW_ID_ER1_1:
case HW_ID_ER1_2:
lcd_id = ZE550ML_TM;
break;
default:
lcd_id = ZE550ML_TM_MP;
break;
}
} else {
lcd_id = ZE550ML_CPT;
}
}
printk("[DISP] %s : Panel ID = %d, ", __func__, lcd_id);
switch(lcd_id) {
case 1:
printk("ZE500ML_HSD registered.\n");
break;
case 2:
printk("ZE500ML_CTP registered.\n");
break;
case 3:
printk("ZE500ML_TM registered.\n");
break;
case 4:
printk("ZE550ML_TM registered.\n");
break;
case 5:
printk("ZE550ML_CPT registered.\n");
break;
case 6:
printk("ZE550ML_TM SR registered.\n");
break;
case 7:
printk("ZE550ML_TM MP registered.\n");
break;
}
}
void intel_register_i2c_camera_device(struct sfi_device_table_entry *pentry,
struct devs_id *dev)
{
struct i2c_board_info i2c_info;
struct i2c_board_info *idev = &i2c_info;
int bus = pentry->host_num;
void *pdata = NULL;
int n_subdev;
const struct intel_v4l2_subdev_id *vdev = get_v4l2_ids(&n_subdev);
struct intel_v4l2_subdev_i2c_board_info *info;
static struct intel_v4l2_subdev_table *subdev_table;
enum intel_v4l2_subdev_type type = 0;
enum atomisp_camera_port port;
static int i;
if (vdev == NULL) {
pr_info("ERROR: camera vdev list is NULL\n");
return;
}
memset(&i2c_info, 0, sizeof(i2c_info));
//ASUS_BSP+++
if (PROJECT_ID == 0xFF) {
PROJECT_ID = Read_PROJ_ID();
}
pr_info("%s(%d):Project ID = %d\n",
__func__, __LINE__, PROJECT_ID);
#if 0
switch (PROJECT_ID) {
case PROJ_ID_Z580C:
if (!strncmp(pentry->name, "t4k35", 16)) {
strncpy(pentry->name, "hm2051", SFI_NAME_LEN);
pentry->addr = 0x24;
pr_info("%s: Change sensor name\n", __func__);
}
break;
default:
break;
}
#endif
//ASUS_BSP---
strncpy(i2c_info.type, pentry->name, SFI_NAME_LEN);
i2c_info.irq = ((pentry->irq == (u8)0xff) ? 0 : pentry->irq);
i2c_info.addr = pentry->addr;
pr_info("camera pdata: I2C bus = %d, name = %16.16s, irq = 0x%2x, addr = 0x%x\n",
pentry->host_num, i2c_info.type, i2c_info.irq, i2c_info.addr);
if (!dev->get_platform_data)
return;
pdata = dev->get_platform_data(&i2c_info);
i2c_info.platform_data = pdata;
while (vdev->name[0]) {
if (!strncmp(vdev->name, idev->type, 16)) {
/* compare name */
type = vdev->type;
port = vdev->port;
break;
}
vdev++;
}
if (!type) /* not found */
return;
info = kzalloc(sizeof(struct intel_v4l2_subdev_i2c_board_info),
GFP_KERNEL);
if (!info) {
pr_err("MRST: fail to alloc mem for ignored i2c dev %s\n",
idev->type);
return;
}
info->i2c_adapter_id = bus;
/* set platform data */
memcpy(&info->board_info, idev, sizeof(*idev));
if (atomisp_platform_data == NULL) {
subdev_table = kzalloc(sizeof(struct intel_v4l2_subdev_table)
* n_subdev, GFP_KERNEL);
if (!subdev_table) {
pr_err("MRST: fail to alloc mem for v4l2_subdev_table %s\n",
idev->type);
kfree(info);
return;
}
atomisp_platform_data = kzalloc(
sizeof(struct atomisp_platform_data), GFP_KERNEL);
if (!atomisp_platform_data) {
pr_err("%s: fail to alloc mem for atomisp_platform_data %s\n",
__func__, idev->type);
kfree(info);
kfree(subdev_table);
return;
}
i = 0;
atomisp_platform_data->subdevs = subdev_table;
}
memcpy(&subdev_table[i].v4l2_subdev, info, sizeof(*info));
//ASUS_BSP+++
if (PROJECT_ID == 0xFF) {
PROJECT_ID = Read_PROJ_ID();
}
pr_info("%s(%d):Project ID = %d\n",
__func__, __LINE__, PROJECT_ID);
if (HW_ID == 0xFF) {
HW_ID = Read_HW_ID();
}
pr_info("%s(%d):HW ID = %d\n",
__func__, __LINE__, HW_ID);
if (PCB_ID == 0xFF) {
PCB_ID = Read_PCB_ID();
pr_info("%s(%d):PCB ID = %x\n",
__func__, __LINE__, PCB_ID);
switch (PROJECT_ID) {
case PROJ_ID_FE380CG:
case PROJ_ID_FE380CXG:
project_id = PCB_ID & 0x7;
hardware_id = (PCB_ID & 0x38) >> 3;
offset_0 = (PCB_ID & 0x40) >> 6;
offset_1 = (PCB_ID & 0x180) >> 7;
offset_2 = (PCB_ID & 0x1E00) >> 9;
offset_3 = (PCB_ID & 0x6000) >> 13;
offset_4 = (PCB_ID & 0x8000) >> 15;
//offset_0: Panel ID, offset_1: TP_ID, offset_2: RF ID(last bit is SIM ID), offset_3: Main Camera ID, offset_4: Sub Camera ID
//PCB_ID = pentry->project_id | pentry->hardware_id << 3 | pentry->offset_0 << 6 | pentry->offset_1 << 7 | pentry->offset_2 << 9 | pentry->offset_3 << 13 | pentry->offset_4 << 15;
pr_info("%s: project id = %d, hardware id = %d, offset_0 = %d, offset_1 = %d, offset_2 = %d, offset_3 = %d, offset_4 = %d\n", __func__, project_id, hardware_id, offset_0, offset_1, offset_2, offset_3, offset_4);
break;
case PROJ_ID_Z580C:
project_id = PCB_ID & 0x7;
hardware_id = (PCB_ID & 0x38) >> 3;
offset_0 = (PCB_ID & 0x40) >> 6;
offset_1 = (PCB_ID & 0x80) >> 7;
offset_2 = (PCB_ID & 0x700) >> 8;
offset_3 = (PCB_ID & 0x1800) >> 11;
offset_4 = (PCB_ID & 0x2000) >> 13;
//offset_0: Panel ID, offset_1: Wifi ID, offset_2: RF ID, offset_3: Main Camera ID, offset_4: Sub Camera ID
//PCB_ID = pentry->project_id | pentry->hardware_id << 3 | pentry->offset_0 << 6 | pentry->offset_1 << 7 | pentry->offset_2 << 8 | pentry->offset_3 << 11 | pentry->offset_4 << 13;
pr_info("%s: project id = %d, hardware id = %d, offset_0 = %d, offset_1 = %d, offset_2 = %d, offset_3 = %d, offset_4 = %d\n", __func__, project_id, hardware_id, offset_0, offset_1, offset_2, offset_3, offset_4);
break;
default:
break;
}
}
