322 lines
7.5 KiB
C
322 lines
7.5 KiB
C
#include "asm/iic.h"
|
||
#include "asm/isp_dev.h"
|
||
#include "h7375s.h"
|
||
#include "gpio.h"
|
||
#include "generic/jiffies.h"
|
||
#include "device/iic.h"
|
||
#include "device/device.h"
|
||
#include "app_config.h"
|
||
|
||
#ifdef CONFIG_VIDEO_ENABLE
|
||
|
||
static void *iic = NULL;
|
||
static u8 H7375S_reset_io[2] = {-1, -1};
|
||
static u8 H7375S_power_io[2] = {-1, -1};
|
||
|
||
#if (CONFIG_VIDEO_IMAGE_W > 640)
|
||
#define H7375S_DEVP_INPUT_W 640
|
||
#define H7375S_DEVP_INPUT_H 480
|
||
#else
|
||
#define H7375S_DEVP_INPUT_W CONFIG_VIDEO_IMAGE_W
|
||
#define H7375S_DEVP_INPUT_H CONFIG_VIDEO_IMAGE_H
|
||
#endif
|
||
|
||
#define H7375S_WRCMD 0xd0
|
||
#define H7375S_RDCMD 0xd1
|
||
|
||
#define CONFIG_INPUT_FPS 25
|
||
|
||
#define DELAY_TIME 10
|
||
|
||
struct reginfo {
|
||
u8 reg;
|
||
u8 val;
|
||
};
|
||
static const struct reginfo sensor_init_data[] = {
|
||
{0xf0, 0x01},
|
||
{0xd4, 0x11},
|
||
{0xf0, 0x00},
|
||
{0x02, 0x69},
|
||
{0x0b, 0x0c},
|
||
{0x28, 0x06},
|
||
{0x30, 0xa9},
|
||
{0x35, 0xa8},
|
||
{0x38, 0x80},
|
||
{0x50, 0x00},
|
||
{0x70, 0x4f},
|
||
{0x72, 0x44},
|
||
{0x76, 0x1c},
|
||
{0x7c, 0x2a},
|
||
{0x7e, 0x11},
|
||
{0x8b, 0x10},
|
||
{0x9e, 0xb2},
|
||
{0xb0, 0x81},
|
||
{0xb2, 0x14},
|
||
{0xb3, 0x25},
|
||
{0xb4, 0x0b},
|
||
{0xb5, 0x20},
|
||
{0xbc, 0x1c},
|
||
{0xbd, 0x11},
|
||
{0xc0, 0x03},
|
||
{0xc1, 0xcc},
|
||
{0xc4, 0x2c},
|
||
{0xc7, 0x00},
|
||
{0xe0, 0x0f},
|
||
{0xe7, 0xef},
|
||
{0xea, 0xb0},
|
||
{0xf0, 0x01},
|
||
{0x20, 0x10},
|
||
{0x21, 0x98},
|
||
{0x22, 0x08},
|
||
{0x23, 0x8c},
|
||
{0x24, 0x20},
|
||
{0x25, 0x94},
|
||
{0x26, 0x18},
|
||
{0x27, 0xc8},
|
||
{0x28, 0x30},
|
||
{0x29, 0x11},
|
||
{0x48, 0xe6},
|
||
{0x49, 0xc0},
|
||
{0x4a, 0xd0},
|
||
{0x4b, 0x48},
|
||
{0x4d, 0x00},
|
||
{0x4f, 0x88},
|
||
{0x70, 0x02},
|
||
{0x71, 0x82},
|
||
{0x72, 0x08},
|
||
{0x73, 0x02},
|
||
{0x74, 0xe2},
|
||
{0x75, 0x10},
|
||
{0x77, 0x08},
|
||
{0x79, 0x04},
|
||
{0x7a, 0x0e},
|
||
{0xd1, 0xc1},
|
||
{0xd2, 0x00},
|
||
{0xd3, 0x00},
|
||
{0xd6, 0x10},
|
||
{0xd7, 0x10},
|
||
{0xf0, 0x00},
|
||
};
|
||
|
||
static s32 H7375S_set_output_size(u16 *width, u16 *height, u8 *freq);
|
||
static unsigned char wrH7375SReg(unsigned char regID, unsigned char regDat)
|
||
{
|
||
u8 ret = 1;
|
||
dev_ioctl(iic, IIC_IOCTL_START, 0);
|
||
if (dev_ioctl(iic, IIC_IOCTL_TX_WITH_START_BIT, H7375S_WRCMD)) {
|
||
ret = 0;
|
||
printf("iic write err!!! line : %d \n", __LINE__);
|
||
goto exit;
|
||
}
|
||
delay(DELAY_TIME);
|
||
if (dev_ioctl(iic, IIC_IOCTL_TX, regID)) {
|
||
ret = 0;
|
||
printf("iic write err!!! line : %d \n", __LINE__);
|
||
goto exit;
|
||
}
|
||
delay(DELAY_TIME);
|
||
if (dev_ioctl(iic, IIC_IOCTL_TX_WITH_STOP_BIT, regDat)) {
|
||
ret = 0;
|
||
printf("iic write err!!! line : %d \n", __LINE__);
|
||
goto exit;
|
||
}
|
||
delay(DELAY_TIME);
|
||
|
||
exit:
|
||
dev_ioctl(iic, IIC_IOCTL_STOP, 0);
|
||
return ret;
|
||
}
|
||
|
||
static unsigned char rdH7375SReg(unsigned char regID, unsigned char *regDat)
|
||
{
|
||
u8 ret = 1;
|
||
dev_ioctl(iic, IIC_IOCTL_START, 0);
|
||
if (dev_ioctl(iic, IIC_IOCTL_TX_WITH_START_BIT, H7375S_WRCMD)) {
|
||
ret = 0;
|
||
printf("iic write err!!! line : %d \n", __LINE__);
|
||
goto exit;
|
||
}
|
||
delay(DELAY_TIME);
|
||
if (dev_ioctl(iic, IIC_IOCTL_TX_WITH_STOP_BIT, regID)) {
|
||
ret = 0;
|
||
printf("iic write err!!! line : %d \n", __LINE__);
|
||
goto exit;
|
||
}
|
||
delay(DELAY_TIME);
|
||
if (dev_ioctl(iic, IIC_IOCTL_TX_WITH_START_BIT, H7375S_RDCMD)) {
|
||
ret = 0;
|
||
printf("iic write err!!! line : %d \n", __LINE__);
|
||
goto exit;
|
||
}
|
||
delay(DELAY_TIME);
|
||
dev_ioctl(iic, IIC_IOCTL_RX_WITH_STOP_BIT, (u32)regDat);
|
||
|
||
exit:
|
||
dev_ioctl(iic, IIC_IOCTL_STOP, 0);
|
||
return ret;
|
||
}
|
||
|
||
static void H7375S_config_SENSOR(u16 *width, u16 *height, u8 *format, u8 *frame_freq)
|
||
{
|
||
int i;
|
||
for (i = 0; i < sizeof(sensor_init_data) / sizeof(sensor_init_data[0]); i++) {
|
||
wrH7375SReg(sensor_init_data[i].reg, sensor_init_data[i].val);
|
||
}
|
||
*format = SEN_IN_FORMAT_UYVY;
|
||
*frame_freq = CONFIG_INPUT_FPS;
|
||
}
|
||
static s32 H7375S_set_output_size(u16 *width, u16 *height, u8 *freq)
|
||
{
|
||
u16 liv_width = *width;
|
||
u16 liv_height = *height;
|
||
return 0;
|
||
}
|
||
static s32 H7375S_power_ctl(u8 isp_dev, u8 is_work)
|
||
{
|
||
return 0;
|
||
}
|
||
|
||
static s32 H7375S_ID_check(void)
|
||
{
|
||
int ret;
|
||
u16 pid = 0x00;
|
||
u8 id0, id1;
|
||
ret = rdH7375SReg(0xfc, &id0);
|
||
rdH7375SReg(0xfd, &id1);
|
||
pid = (u16)((id0 << 8) | id1);
|
||
printf("H7375S Sensor ID : 0x%x\n", pid);
|
||
if (pid != 0x1703) {
|
||
return -1;
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
static void H7375S_powerio_ctl(u32 _power_gpio, u32 on_off)
|
||
{
|
||
gpio_direction_output(_power_gpio, on_off);
|
||
}
|
||
static void H7375S_reset(u8 isp_dev)
|
||
{
|
||
u8 res_io;
|
||
u8 powd_io;
|
||
u8 id = 0;
|
||
puts("H7375S reset\n");
|
||
|
||
if (isp_dev == ISP_DEV_0) {
|
||
res_io = (u8)H7375S_reset_io[0];
|
||
powd_io = (u8)H7375S_power_io[0];
|
||
} else {
|
||
res_io = (u8)H7375S_reset_io[1];
|
||
powd_io = (u8)H7375S_power_io[1];
|
||
}
|
||
|
||
if (powd_io != (u8) - 1) {
|
||
H7375S_powerio_ctl((u32)powd_io, 0);
|
||
}
|
||
if (res_io != (u8) - 1) {
|
||
gpio_direction_output(res_io, 1);
|
||
gpio_direction_output(res_io, 0);
|
||
os_time_dly(1);
|
||
gpio_direction_output(res_io, 1);
|
||
}
|
||
}
|
||
|
||
|
||
static s32 H7375S_check(u8 isp_dev, u32 _reset_gpio, u32 _power_gpio)
|
||
{
|
||
if (!iic) {
|
||
if (isp_dev == ISP_DEV_0) {
|
||
iic = dev_open("iic0", 0);
|
||
} else {
|
||
iic = dev_open("iic1", 0);
|
||
}
|
||
H7375S_reset_io[isp_dev] = (u8)_reset_gpio;
|
||
H7375S_power_io[isp_dev] = (u8)_power_gpio;
|
||
}
|
||
if (iic == NULL) {
|
||
printf("H7375S iic open err!!!\n\n");
|
||
return -1;
|
||
}
|
||
H7375S_reset(isp_dev);
|
||
|
||
if (0 != H7375S_ID_check()) {
|
||
dev_close(iic);
|
||
iic = NULL;
|
||
printf("-------not H7375S------\n\n");
|
||
return -1;
|
||
}
|
||
printf("-------hello H7375S------\n\n");
|
||
return 0;
|
||
}
|
||
|
||
|
||
static s32 H7375S_init(u8 isp_dev, u16 *width, u16 *height, u8 *format, u8 *frame_freq)
|
||
{
|
||
puts("H7375S \n\n");
|
||
if (0 != H7375S_check(isp_dev, 0, 0)) {
|
||
return -1;
|
||
}
|
||
H7375S_config_SENSOR(width, height, format, frame_freq);
|
||
|
||
return 0;
|
||
}
|
||
void set_rev_sensor_H7375S(u16 rev_flag)
|
||
{
|
||
if (!rev_flag) {
|
||
wrH7375SReg(0x0b, 0x0c);
|
||
} else {
|
||
wrH7375SReg(0x0b, 0x04);
|
||
}
|
||
}
|
||
|
||
u16 H7375S_dvp_rd_reg(u16 addr)
|
||
{
|
||
u8 val;
|
||
rdH7375SReg((u8)addr, &val);
|
||
return val;
|
||
}
|
||
|
||
void H7375S_dvp_wr_reg(u16 addr, u16 val)
|
||
{
|
||
wrH7375SReg((u8)addr, (u8)val);
|
||
}
|
||
|
||
// *INDENT-OFF*
|
||
REGISTER_CAMERA(H7375S) = {
|
||
.logo = "H7375S",
|
||
.isp_dev = ISP_DEV_NONE,
|
||
.in_format = SEN_IN_FORMAT_UYVY,
|
||
.mbus_type = SEN_MBUS_PARALLEL,
|
||
.mbus_config = SEN_MBUS_DATA_WIDTH_8B | SEN_MBUS_HSYNC_ACTIVE_HIGH | \
|
||
SEN_MBUS_PCLK_SAMPLE_FALLING | SEN_MBUS_VSYNC_ACTIVE_HIGH,
|
||
#if CONFIG_CAMERA_H_V_EXCHANGE
|
||
.sync_config = SEN_MBUS_SYNC0_VSYNC_SYNC1_HSYNC,//WL82/AC791才可以H-V SYNC互换，请留意
|
||
#endif
|
||
.fps = CONFIG_INPUT_FPS,
|
||
.out_fps = CONFIG_INPUT_FPS,
|
||
.sen_size = {H7375S_DEVP_INPUT_W, H7375S_DEVP_INPUT_H},
|
||
.cap_fps = CONFIG_INPUT_FPS,
|
||
.sen_cap_size = {H7375S_DEVP_INPUT_W, H7375S_DEVP_INPUT_H},
|
||
|
||
|
||
.ops = {
|
||
.avin_fps = NULL,
|
||
.avin_valid_signal = NULL,
|
||
.avin_mode_det = NULL,
|
||
.sensor_check = H7375S_check,
|
||
.init = H7375S_init,
|
||
.set_size_fps = H7375S_set_output_size,
|
||
.power_ctrl = H7375S_power_ctl,
|
||
|
||
|
||
.sleep = NULL,
|
||
.wakeup = NULL,
|
||
.write_reg = H7375S_dvp_wr_reg,
|
||
.read_reg = H7375S_dvp_rd_reg,
|
||
.set_sensor_reverse = set_rev_sensor_H7375S,
|
||
}
|
||
};
|
||
|
||
#endif
|