mirror of
https://gitee.com/Vancouver2017/luban-lite.git
synced 2025-12-17 01:28:54 +00:00
345 lines
8.4 KiB
C
345 lines
8.4 KiB
C
/*
|
|
* Copyright (c) 2024-2025, ArtInChip Technology Co., Ltd
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*
|
|
* Authors: matteo <duanmt@artinchip.com>
|
|
*/
|
|
|
|
#define LOG_TAG "gm7150"
|
|
|
|
#include <drivers/i2c.h>
|
|
#include <drivers/pin.h>
|
|
|
|
#include "aic_core.h"
|
|
#include "mpp_types.h"
|
|
#include "mpp_img_size.h"
|
|
#include "mpp_vin.h"
|
|
|
|
#include "drv_camera.h"
|
|
#include "camera_inner.h"
|
|
|
|
/* Default format configuration of GM7150 */
|
|
#define GM7150_DFT_WIDTH PAL_WIDTH
|
|
#define GM7150_DFT_HEIGHT PAL_HEIGHT
|
|
#define GM7150_DFT_BUS_TYPE MEDIA_BUS_BT656
|
|
#define GM7150_DFT_CODE MEDIA_BUS_FMT_UYVY8_2X8
|
|
|
|
#define GM7150_I2C_SLAVE_ID 0x5C // or 0x5D
|
|
#define GM7150_CHIP_ID 0x7150
|
|
|
|
#define GM7150_BRIGHTNESS_REG 0x09
|
|
#define GM7150_SATURATION_REG 0x0A
|
|
#define GM7150_HUE_REG 0x0B
|
|
#define GM7150_CONTRAST_REG 0x0C
|
|
|
|
struct gm7150_dev {
|
|
struct rt_device dev;
|
|
struct rt_i2c_bus_device *i2c;
|
|
u32 rst_pin;
|
|
u32 pwdn_pin;
|
|
|
|
struct mpp_video_fmt fmt;
|
|
|
|
bool on;
|
|
bool streaming;
|
|
};
|
|
|
|
static struct gm7150_dev g_gm7150_dev = {0};
|
|
|
|
static struct reg8_info gm7150_bt656_regs[] = {
|
|
{0x03, 0x0D},
|
|
{0x11, 0x04},
|
|
{0x12, 0x00},
|
|
{0x13, 0x04},
|
|
{0x14, 0x00},
|
|
{0xA0, 0x55},
|
|
{0xA1, 0xAA},
|
|
{0x69, 0x40},
|
|
{0x6D, 0x90},
|
|
};
|
|
|
|
static int gm7150_write_reg(struct rt_i2c_bus_device *i2c, u8 reg, u8 val)
|
|
{
|
|
if (rt_i2c_write_reg(i2c, GM7150_I2C_SLAVE_ID, reg, &val, 1) != 1) {
|
|
LOG_E("%s: error: reg = 0x%x, val = 0x%x", __func__, reg, val);
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int gm7150_read_reg(struct rt_i2c_bus_device *i2c, u8 reg, u8 *val)
|
|
{
|
|
if (rt_i2c_read_reg(i2c, GM7150_I2C_SLAVE_ID, reg, val, 1) != 1) {
|
|
LOG_E("%s: error: reg = 0x%x, val = 0x%x", __func__, reg, *val);
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void gm7150_select_ch(struct gm7150_dev *sensor, u32 ch)
|
|
{
|
|
if (ch)
|
|
gm7150_write_reg(sensor->i2c, 0x00, 0x02);
|
|
else
|
|
gm7150_write_reg(sensor->i2c, 0x00, 0x00);
|
|
}
|
|
|
|
static void gm7150_out_bt656(struct gm7150_dev *sensor)
|
|
{
|
|
struct reg8_info *info = gm7150_bt656_regs;
|
|
int i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(gm7150_bt656_regs); i++, info++)
|
|
gm7150_write_reg(sensor->i2c, info->reg, info->val);
|
|
}
|
|
|
|
static void gm7150_cur_status(struct gm7150_dev *sensor)
|
|
{
|
|
u8 val = 0, fmt = 0;
|
|
char *formats[] = {"Reserved", "NTSC BT.601", "Reserved", "PAL BT.601",
|
|
"Reserved", "(M)PAL BT.601", "Reserved", "PAL-N BT.601",
|
|
"Reserved", "NTSC 4.43 BT.601", "Reserved", "Reserved",
|
|
"Reserved", "Reserved", "Reserved", "Reserved"};
|
|
|
|
gm7150_read_reg(sensor->i2c, 0x88, &val);
|
|
LOG_I("Reg 0x%02x: 0x%02x. Input signal is %s\n", 0x88, val,
|
|
(val & 0x6) == 0x6 ? "valid" : "invalid");
|
|
|
|
gm7150_read_reg(sensor->i2c, 0x8C, &val);
|
|
fmt = val & 0xF;
|
|
LOG_I("Reg 0x%02x: 0x%02x. Input format: %s\n", 0x8C, val,
|
|
formats[fmt]);
|
|
|
|
if (fmt == 0x1 || fmt == 9)
|
|
g_gm7150_dev.fmt.height = NTSC_HEIGHT;
|
|
}
|
|
|
|
static bool gm7150_is_open(struct gm7150_dev *sensor)
|
|
{
|
|
return sensor->on;
|
|
}
|
|
|
|
static void gm7150_power_on(struct gm7150_dev *sensor)
|
|
{
|
|
if (sensor->on)
|
|
return;
|
|
|
|
aicos_msleep(30);
|
|
camera_pin_set_low(sensor->pwdn_pin);
|
|
aicos_msleep(10);
|
|
camera_pin_set_high(sensor->pwdn_pin);
|
|
aicos_msleep(30);
|
|
|
|
LOG_I("Power on");
|
|
sensor->on = true;
|
|
}
|
|
|
|
static void gm7150_power_off(struct gm7150_dev *sensor)
|
|
{
|
|
if (!sensor->on)
|
|
return;
|
|
|
|
if (sensor->pwdn_pin)
|
|
camera_pin_set_low(sensor->pwdn_pin);
|
|
|
|
LOG_I("Power off");
|
|
sensor->on = false;
|
|
}
|
|
|
|
static int gm7150_probe(struct gm7150_dev *sensor)
|
|
{
|
|
u8 id_h = 0, id_l = 0;
|
|
|
|
gm7150_power_on(sensor);
|
|
|
|
if (gm7150_read_reg(sensor->i2c, 0x80, &id_h) ||
|
|
gm7150_read_reg(sensor->i2c, 0x81, &id_l))
|
|
return -1;
|
|
|
|
if ((id_h << 8 | id_l) != GM7150_CHIP_ID) {
|
|
LOG_E("Invalid chip ID: %02x %02x\n", id_h, id_l);
|
|
return -1;
|
|
}
|
|
gm7150_select_ch(sensor, 0);
|
|
gm7150_out_bt656(sensor);
|
|
gm7150_cur_status(sensor);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static rt_err_t gm7150_init(rt_device_t dev)
|
|
{
|
|
struct gm7150_dev *sensor = (struct gm7150_dev *)dev;
|
|
|
|
sensor->i2c = camera_i2c_get();
|
|
if (!sensor->i2c)
|
|
return -RT_EINVAL;
|
|
|
|
sensor->fmt.code = GM7150_DFT_CODE;
|
|
sensor->fmt.width = GM7150_DFT_WIDTH;
|
|
sensor->fmt.height = GM7150_DFT_HEIGHT;
|
|
sensor->fmt.bus_type = GM7150_DFT_BUS_TYPE;
|
|
sensor->fmt.flags = MEDIA_SIGNAL_HSYNC_ACTIVE_HIGH |
|
|
MEDIA_SIGNAL_VSYNC_ACTIVE_HIGH |
|
|
MEDIA_SIGNAL_PCLK_SAMPLE_RISING |
|
|
MEDIA_SIGNAL_INTERLACED_MODE;
|
|
|
|
sensor->pwdn_pin = camera_pwdn_pin_get();
|
|
if (!sensor->pwdn_pin)
|
|
return -RT_EINVAL;
|
|
|
|
return RT_EOK;
|
|
}
|
|
|
|
static rt_err_t gm7150_open(rt_device_t dev, rt_uint16_t oflag)
|
|
{
|
|
struct gm7150_dev *sensor = (struct gm7150_dev *)dev;
|
|
|
|
if (gm7150_is_open(sensor))
|
|
return RT_EOK;
|
|
|
|
|
|
if (gm7150_probe(sensor))
|
|
return -RT_ERROR;
|
|
|
|
LOG_I("GM7150 inited");
|
|
return RT_EOK;
|
|
}
|
|
|
|
static rt_err_t gm7150_close(rt_device_t dev)
|
|
{
|
|
struct gm7150_dev *sensor = (struct gm7150_dev *)dev;
|
|
|
|
if (!gm7150_is_open(sensor))
|
|
return -RT_ERROR;
|
|
|
|
gm7150_power_off(sensor);
|
|
LOG_D("GM7150 Close");
|
|
return RT_EOK;
|
|
}
|
|
|
|
static int gm7150_get_fmt(struct gm7150_dev *sensor, struct mpp_video_fmt *cfg)
|
|
{
|
|
cfg->code = sensor->fmt.code;
|
|
cfg->width = sensor->fmt.width;
|
|
cfg->height = sensor->fmt.height;
|
|
cfg->flags = sensor->fmt.flags;
|
|
cfg->bus_type = sensor->fmt.bus_type;
|
|
return RT_EOK;
|
|
}
|
|
|
|
static int gm7150_start(rt_device_t dev)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static int gm7150_stop(rt_device_t dev)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
static u8 g_gm7150_workmode = 0;
|
|
|
|
static int gm7150_pause(rt_device_t dev)
|
|
{
|
|
struct gm7150_dev *sensor = (struct gm7150_dev *)dev;
|
|
|
|
gm7150_read_reg(sensor->i2c, 0x2, &g_gm7150_workmode);
|
|
return gm7150_write_reg(sensor->i2c, 0x2, 0x1);
|
|
}
|
|
|
|
static int gm7150_resume(rt_device_t dev)
|
|
{
|
|
struct gm7150_dev *sensor = (struct gm7150_dev *)dev;
|
|
|
|
return gm7150_write_reg(sensor->i2c, 0x2, g_gm7150_workmode);
|
|
}
|
|
|
|
static int gm7150_set_brightness(struct gm7150_dev *sensor, u32 percent)
|
|
{
|
|
u8 val = PERCENT_TO_INT(0, 255, percent);
|
|
|
|
return gm7150_write_reg(sensor->i2c, GM7150_BRIGHTNESS_REG, val);
|
|
}
|
|
|
|
static int gm7150_set_saturation(struct gm7150_dev *sensor, u32 percent)
|
|
{
|
|
u8 val = PERCENT_TO_INT(0, 255, percent);
|
|
|
|
return gm7150_write_reg(sensor->i2c, GM7150_SATURATION_REG, val);
|
|
}
|
|
|
|
static int gm7150_set_hue(struct gm7150_dev *sensor, u32 percent)
|
|
{
|
|
s8 val = PERCENT_TO_INT((s8)0x80, (s8)0x7F, percent);
|
|
|
|
return gm7150_write_reg(sensor->i2c, GM7150_HUE_REG, val);
|
|
}
|
|
|
|
static int gm7150_set_contrast(struct gm7150_dev *sensor, u32 percent)
|
|
{
|
|
u8 val = PERCENT_TO_INT(0, 255, percent);
|
|
|
|
return gm7150_write_reg(sensor->i2c, GM7150_CONTRAST_REG, val);
|
|
}
|
|
|
|
static rt_err_t gm7150_control(rt_device_t dev, int cmd, void *args)
|
|
{
|
|
struct gm7150_dev *sensor = (struct gm7150_dev *)dev;
|
|
|
|
switch (cmd) {
|
|
case CAMERA_CMD_START:
|
|
return gm7150_start(dev);
|
|
case CAMERA_CMD_STOP:
|
|
return gm7150_stop(dev);
|
|
case CAMERA_CMD_PAUSE:
|
|
return gm7150_pause(dev);
|
|
case CAMERA_CMD_RESUME:
|
|
return gm7150_resume(dev);
|
|
case CAMERA_CMD_GET_FMT:
|
|
return gm7150_get_fmt(sensor, (struct mpp_video_fmt *)args);
|
|
case CAMERA_CMD_SET_CONTRAST:
|
|
return gm7150_set_contrast(sensor, *(u32 *)args);
|
|
case CAMERA_CMD_SET_BRIGHTNESS:
|
|
return gm7150_set_brightness(sensor, *(u32 *)args);
|
|
case CAMERA_CMD_SET_HUE:
|
|
return gm7150_set_hue(sensor, *(u32 *)args);
|
|
case CAMERA_CMD_SET_SATURATION:
|
|
return gm7150_set_saturation(sensor, *(u32 *)args);
|
|
default:
|
|
LOG_I("Unsupported cmd: 0x%x", cmd);
|
|
return -RT_EINVAL;
|
|
}
|
|
return RT_EOK;
|
|
}
|
|
|
|
#ifdef RT_USING_DEVICE_OPS
|
|
static const struct rt_device_ops gm7150_ops =
|
|
{
|
|
.init = gm7150_init,
|
|
.open = gm7150_open,
|
|
.close = gm7150_close,
|
|
.control = gm7150_control,
|
|
};
|
|
#endif
|
|
|
|
int rt_hw_gm7150_init(void)
|
|
{
|
|
#ifdef RT_USING_DEVICE_OPS
|
|
g_gm7150_dev.dev.ops = &gm7150_ops;
|
|
#else
|
|
g_gm7150_dev.dev.init = gm7150_init;
|
|
g_gm7150_dev.dev.open = gm7150_open;
|
|
g_gm7150_dev.dev.close = gm7150_close;
|
|
g_gm7150_dev.dev.control = gm7150_control;
|
|
#endif
|
|
g_gm7150_dev.dev.type = RT_Device_Class_CAMERA;
|
|
|
|
rt_device_register(&g_gm7150_dev.dev, CAMERA_DEV_NAME, 0);
|
|
return 0;
|
|
}
|
|
INIT_DEVICE_EXPORT(rt_hw_gm7150_init);
|