diff options
Diffstat (limited to 'drivers/media/sprd_sensor/power/sensor_power_tshark2tabe.c')
| -rwxr-xr-x | drivers/media/sprd_sensor/power/sensor_power_tshark2tabe.c | 143 |
1 files changed, 143 insertions, 0 deletions
diff --git a/drivers/media/sprd_sensor/power/sensor_power_tshark2tabe.c b/drivers/media/sprd_sensor/power/sensor_power_tshark2tabe.c new file mode 100755 index 00000000..4cfa6f18 --- /dev/null +++ b/drivers/media/sprd_sensor/power/sensor_power_tshark2tabe.c @@ -0,0 +1,143 @@ +/* + * Copyright (C) 2012 Spreadtrum Communications Inc. + * + * This software is licensed under the terms of the GNU General Public + * License version 2, as published by the Free Software Foundation, and + * may be copied, distributed, and modified under those terms. + * + * 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 <linux/module.h> +#include <linux/kernel.h> +#include <linux/init.h> +#include <linux/bitops.h> +#include <linux/delay.h> +#include <linux/kernel.h> +#include <soc/sprd/hardware.h> +#include <soc/sprd/board.h> +#include "../sensor_drv_sprd.h" + +static int sensor_hi544_poweron(uint32_t *fd_handle, struct sensor_power *dev0, struct sensor_power *dev1, struct sensor_power *dev2) +{ + int ret = 0; + + sensor_k_sensor_sel(fd_handle, SENSOR_DEV_1);//select sub sensor + sensor_k_set_pd_level(fd_handle, 0);//power down + sensor_k_set_rst_level(fd_handle, 0);//reset + sensor_k_sensor_sel(fd_handle, SENSOR_DEV_0);//select main sensor + sensor_k_set_pd_level(fd_handle, 0);//power down + sensor_k_set_rst_level(fd_handle, 0);//reset + udelay(10); + sensor_k_set_voltage_cammot(fd_handle, SENSOR_VDD_2800MV); + sensor_k_set_voltage_iovdd(fd_handle, SENSOR_VDD_1800MV); + udelay(10); + sensor_k_set_voltage_avdd(fd_handle, SENSOR_VDD_2800MV); + mdelay(6);//delay 6ms < 10ms + sensor_k_set_pd_level(fd_handle, 1); + mdelay(2);//delay 2ms > 1ms + sensor_k_set_mclk(fd_handle, 24); + mdelay(30);//delay 30ms >= 30ms + sensor_k_set_rst_level(fd_handle, 1); + udelay(2);//delay 2us > 16MCLK = 16/24 us + printk("hi544_poweron OK \n"); + + return ret; +} + +static int sensor_hi544_poweroff(uint32_t *fd_handle, struct sensor_power *dev0, struct sensor_power *dev1, struct sensor_power *dev2) +{ + int ret = 0; + + sensor_k_sensor_sel(fd_handle, SENSOR_DEV_0);//select main sensor + udelay(2);//delay 2us > 16MCLK = 16/24 us + sensor_k_set_rst_level(fd_handle, 0);//reset + mdelay(10);//delay 2us > 16MCLK = 16/24 us + sensor_k_set_mclk(fd_handle, 0);// disable mclk + udelay(1);//delay 1us > 0ns + sensor_k_set_pd_level(fd_handle, 0);//power down + mdelay(6);//delay 6ms < 10ms + sensor_k_set_voltage_avdd(fd_handle, SENSOR_VDD_CLOSED); + mdelay(6);//delay 6ms < 10ms + sensor_k_set_voltage_iovdd(fd_handle, SENSOR_VDD_CLOSED); + udelay(1); + sensor_k_set_voltage_cammot(fd_handle, SENSOR_VDD_CLOSED); + printk("hi544_poweroff OK \n"); + + return ret; +} + + +static int sensor_hi255_poweron(uint32_t *fd_handle, struct sensor_power *dev0, struct sensor_power *dev1, struct sensor_power *dev2) +{ + int ret = 0; + + sensor_k_sensor_sel(fd_handle, SENSOR_DEV_0);//select sub sensor + sensor_k_set_pd_level(fd_handle, 0);//power down + sensor_k_set_rst_level(fd_handle, 0);//reset + sensor_k_sensor_sel(fd_handle, SENSOR_DEV_1);//select main sensor + sensor_k_set_pd_level(fd_handle, 0);//power down + sensor_k_set_rst_level(fd_handle, 0);//reset + udelay(1); + sensor_k_set_voltage_iovdd(fd_handle, SENSOR_VDD_1800MV); + mdelay(6);//delay 6ms < 10ms + sensor_k_set_voltage_avdd(fd_handle, SENSOR_VDD_2800MV); + mdelay(6);//delay 6ms < 10ms + sensor_k_set_pd_level(fd_handle, 1); + mdelay(2);//delay 2ms > 1ms + sensor_k_set_mclk(fd_handle, 24); + mdelay(30);//delay 30ms >= 30ms + sensor_k_set_rst_level(fd_handle, 1); + udelay(2);//delay 2us > 16MCLK = 16/24 us + printk("hi255_poweron OK \n"); + + return ret; +} + +static int sensor_hi255_poweroff(uint32_t *fd_handle, struct sensor_power *dev0, struct sensor_power *dev1, struct sensor_power *dev2) +{ + int ret = 0; + + sensor_k_sensor_sel(fd_handle, SENSOR_DEV_1);//select main sensor + udelay(2);//delay 2us > 16MCLK = 16/24 us + sensor_k_set_rst_level(fd_handle, 0);//reset + udelay(2);//delay 2us > 16MCLK = 16/24 us + sensor_k_set_mclk(fd_handle, 0);// disable mclk + udelay(1);//delay 1us > 0ns + sensor_k_set_pd_level(fd_handle, 0);//power down + mdelay(6);//delay 6ms < 10ms + sensor_k_set_voltage_avdd(fd_handle, SENSOR_VDD_CLOSED); + //mdelay(6);//delay 6ms < 10ms + sensor_k_set_voltage_iovdd(fd_handle, SENSOR_VDD_CLOSED); + udelay(1); + printk("hi255_poweroff OK \n"); + + return ret; +} + +int sensor_power_on(uint32_t *fd_handle, uint32_t sensor_id, struct sensor_power *dev0, struct sensor_power *dev1, struct sensor_power *dev2) +{ + int ret = 0; + + if (SENSOR_DEV_0 == sensor_id) { + ret = sensor_hi544_poweron(fd_handle, dev0, dev1, dev2); + } else if (SENSOR_DEV_1 == sensor_id) { + ret = sensor_hi255_poweron(fd_handle, dev0, dev1, dev2); + } + return ret; +} + +int sensor_power_off(uint32_t *fd_handle, uint32_t sensor_id, struct sensor_power *dev0, struct sensor_power *dev1, struct sensor_power *dev2) +{ + int ret = 0; + + if (SENSOR_DEV_0 == sensor_id) { + ret = sensor_hi544_poweroff(fd_handle, dev0, dev1, dev2); + } else if (SENSOR_DEV_1 == sensor_id) { + ret = sensor_hi255_poweroff(fd_handle, dev0, dev1, dev2); + } + + return ret; +} |