1150 lines
20 KiB
C
1150 lines
20 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* vehicle sensor gc2145
|
|
*
|
|
* Copyright (C) 2020 Rockchip Electronics Co.Ltd
|
|
* Authors:
|
|
* Zhiqin Wei <wzq@rock-chips.com>
|
|
*
|
|
*/
|
|
|
|
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/sysctl.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/proc_fs.h>
|
|
#include <linux/suspend.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/io.h>
|
|
#include <linux/irq.h>
|
|
#include <linux/uaccess.h>
|
|
#include <linux/of_gpio.h>
|
|
#include <linux/of_irq.h>
|
|
#include "vehicle_cfg.h"
|
|
#include "vehicle_main.h"
|
|
#include "vehicle_ad.h"
|
|
#include "vehicle_ad_gc2145.h"
|
|
#include <media/v4l2-mediabus.h>
|
|
|
|
enum {
|
|
CVSTD_720P60 = 0,
|
|
CVSTD_720P50,
|
|
CVSTD_1080P30,
|
|
CVSTD_1080P25,
|
|
CVSTD_720P30,
|
|
CVSTD_720P25,
|
|
CVSTD_SVGAP30,
|
|
CVSTD_SD,
|
|
CVSTD_NTSC,
|
|
CVSTD_PAL
|
|
};
|
|
|
|
enum {
|
|
FORCE_PAL_WIDTH = 960,
|
|
FORCE_PAL_HEIGHT = 576,
|
|
FORCE_NTSC_WIDTH = 960,
|
|
FORCE_NTSC_HEIGHT = 480,
|
|
FORCE_SVGA_WIDTH = 800,
|
|
FORCE_SVGA_HEIGHT = 600,
|
|
FORCE_CIF_OUTPUT_FORMAT = CIF_OUTPUT_FORMAT_422,
|
|
};
|
|
|
|
enum {
|
|
VIDEO_UNPLUG,
|
|
VIDEO_IN,
|
|
VIDEO_LOCKED,
|
|
VIDEO_UNLOCK
|
|
};
|
|
#define FLAG_LOSS (0x1 << 7)
|
|
#define FLAG_V_LOCKED (0x1 << 6)
|
|
#define FLAG_H_LOCKED (0x1 << 5)
|
|
#define FLAG_CARRIER_PLL_LOCKED (0x1 << 4)
|
|
#define FLAG_VIDEO_DETECTED (0x1 << 3)
|
|
#define FLAG_EQ_SD_DETECTED (0x1 << 2)
|
|
#define FLAG_PROGRESSIVE (0x1 << 1)
|
|
#define FLAG_NO_CARRIER (0x1 << 0)
|
|
#define FLAG_LOCKED (FLAG_V_LOCKED | FLAG_H_LOCKED)
|
|
|
|
static struct vehicle_ad_dev *gc2145_g_addev;
|
|
static int cvstd_mode = CVSTD_SVGAP30;
|
|
static int cvstd_old = CVSTD_NTSC;
|
|
//static int cvstd_sd = CVSTD_NTSC;
|
|
static int cvstd_state = VIDEO_UNPLUG;
|
|
static int cvstd_old_state = VIDEO_UNLOCK;
|
|
|
|
#define SENSOR_REGISTER_LEN 1 /* sensor register address bytes*/
|
|
#define SENSOR_VALUE_LEN 1 /* sensor register value bytes*/
|
|
|
|
struct rk_sensor_reg {
|
|
unsigned int reg;
|
|
unsigned int val;
|
|
};
|
|
|
|
#define SENSOR_CHANNEL_REG 0x41
|
|
|
|
#define SEQCMD_END 0xFF000000
|
|
#define SensorEnd {SEQCMD_END, 0x00}
|
|
|
|
#define SENSOR_DG VEHICLE_DG
|
|
#define SENSOR_ID(_msb, _lsb) ((_msb) << 8 | (_lsb))
|
|
|
|
/* Preview resolution setting*/
|
|
static struct rk_sensor_reg sensor_preview_data_svga_30hz[] = {
|
|
{0xfe, 0xf0},
|
|
{0xfe, 0xf0},
|
|
{0xfe, 0xf0},
|
|
{0xfc, 0x06},
|
|
{0xf6, 0x00},
|
|
{0xf7, 0x1d},
|
|
{0xf8, 0x84},
|
|
{0xfa, 0x00},
|
|
{0xf9, 0xfe},
|
|
{0xf2, 0x00},
|
|
/*ISP reg*/
|
|
{0xfe, 0x00},
|
|
{0x03, 0x04},
|
|
{0x04, 0xe2},
|
|
{0x09, 0x00},
|
|
{0x0a, 0x00},
|
|
{0x0b, 0x00},
|
|
{0x0c, 0x00},
|
|
{0x0d, 0x04},
|
|
{0x0e, 0xc0},
|
|
{0x0f, 0x06},
|
|
{0x10, 0x52},
|
|
{0x12, 0x2e},
|
|
{0x17, 0x14},
|
|
{0x18, 0x22},
|
|
{0x19, 0x0e},
|
|
{0x1a, 0x01},
|
|
{0x1b, 0x4b},
|
|
{0x1c, 0x07},
|
|
{0x1d, 0x10},
|
|
{0x1e, 0x88},
|
|
{0x1f, 0x78},
|
|
{0x20, 0x03},
|
|
{0x21, 0x40},
|
|
{0x22, 0xa0},
|
|
{0x24, 0x3f},
|
|
{0x25, 0x01},
|
|
{0x26, 0x10},
|
|
{0x2d, 0x60},
|
|
{0x30, 0x01},
|
|
{0x31, 0x90},
|
|
{0x33, 0x06},
|
|
{0x34, 0x01},
|
|
{0xfe, 0x00},
|
|
{0x80, 0x7f},
|
|
{0x81, 0x26},
|
|
{0x82, 0xfa},
|
|
{0x83, 0x00},
|
|
{0x84, 0x00},
|
|
{0x86, 0x02},
|
|
{0x88, 0x03},
|
|
{0x89, 0x03},
|
|
{0x85, 0x08},
|
|
{0x8a, 0x00},
|
|
{0x8b, 0x00},
|
|
{0xb0, 0x55},
|
|
{0xc3, 0x00},
|
|
{0xc4, 0x80},
|
|
{0xc5, 0x90},
|
|
{0xc6, 0x3b},
|
|
{0xc7, 0x46},
|
|
{0xec, 0x06},
|
|
{0xed, 0x04},
|
|
{0xee, 0x60},
|
|
{0xef, 0x90},
|
|
{0xb6, 0x01},
|
|
{0x90, 0x01},
|
|
{0x91, 0x00},
|
|
{0x92, 0x00},
|
|
{0x93, 0x00},
|
|
{0x94, 0x00},
|
|
{0x95, 0x04},
|
|
{0x96, 0xb0},
|
|
{0x97, 0x06},
|
|
{0x98, 0x40},
|
|
/*BLK*/
|
|
{0xfe, 0x00},
|
|
{0x40, 0x42},
|
|
{0x41, 0x00},
|
|
{0x43, 0x5b},
|
|
{0x5e, 0x00},
|
|
{0x5f, 0x00},
|
|
{0x60, 0x00},
|
|
{0x61, 0x00},
|
|
{0x62, 0x00},
|
|
{0x63, 0x00},
|
|
{0x64, 0x00},
|
|
{0x65, 0x00},
|
|
{0x66, 0x20},
|
|
{0x67, 0x20},
|
|
{0x68, 0x20},
|
|
{0x69, 0x20},
|
|
{0x76, 0x00},
|
|
{0x6a, 0x08},
|
|
{0x6b, 0x08},
|
|
{0x6c, 0x08},
|
|
{0x6d, 0x08},
|
|
{0x6e, 0x08},
|
|
{0x6f, 0x08},
|
|
{0x70, 0x08},
|
|
{0x71, 0x08},
|
|
{0x76, 0x00},
|
|
{0x72, 0xf0},
|
|
{0x7e, 0x3c},
|
|
{0x7f, 0x00},
|
|
{0xfe, 0x02},
|
|
{0x48, 0x15},
|
|
{0x49, 0x00},
|
|
{0x4b, 0x0b},
|
|
{0xfe, 0x00},
|
|
/*AEC*/
|
|
{0xfe, 0x01},
|
|
{0x01, 0x04},
|
|
{0x02, 0xc0},
|
|
{0x03, 0x04},
|
|
{0x04, 0x90},
|
|
{0x05, 0x30},
|
|
{0x06, 0x90},
|
|
{0x07, 0x30},
|
|
{0x08, 0x80},
|
|
{0x09, 0x00},
|
|
{0x0a, 0x82},
|
|
{0x0b, 0x11},
|
|
{0x0c, 0x10},
|
|
{0x11, 0x10},
|
|
{0x13, 0x7b},
|
|
{0x17, 0x00},
|
|
{0x1c, 0x11},
|
|
{0x1e, 0x61},
|
|
{0x1f, 0x35},
|
|
{0x20, 0x40},
|
|
{0x22, 0x40},
|
|
{0x23, 0x20},
|
|
{0xfe, 0x02},
|
|
{0x0f, 0x04},
|
|
{0xfe, 0x01},
|
|
{0x12, 0x35},
|
|
{0x15, 0xb0},
|
|
{0x10, 0x31},
|
|
{0x3e, 0x28},
|
|
{0x3f, 0xb0},
|
|
{0x40, 0x90},
|
|
{0x41, 0x0f},
|
|
|
|
/*INTPEE*/
|
|
{0xfe, 0x02},
|
|
{0x90, 0x6c},
|
|
{0x91, 0x03},
|
|
{0x92, 0xcb},
|
|
{0x94, 0x33},
|
|
{0x95, 0x84},
|
|
{0x97, 0x45},
|
|
{0xa2, 0x11},
|
|
{0xfe, 0x00},
|
|
/*DNDD*/
|
|
{0xfe, 0x02},
|
|
{0x80, 0xc1},
|
|
{0x81, 0x08},
|
|
{0x82, 0x1f},
|
|
{0x83, 0x10},
|
|
{0x84, 0x0a},
|
|
{0x86, 0xf0},
|
|
{0x87, 0x50},
|
|
{0x88, 0x15},
|
|
{0x89, 0xb0},
|
|
{0x8a, 0x30},
|
|
{0x8b, 0x10},
|
|
/*ASDE*/
|
|
{0xfe, 0x01},
|
|
{0x21, 0x04},
|
|
{0xfe, 0x02},
|
|
{0xa3, 0x50},
|
|
{0xa4, 0x20},
|
|
{0xa5, 0x40},
|
|
{0xa6, 0x80},
|
|
{0xab, 0x40},
|
|
{0xae, 0x0c},
|
|
{0xb3, 0x46},
|
|
{0xb4, 0x64},
|
|
{0xb6, 0x38},
|
|
{0xb7, 0x01},
|
|
{0xb9, 0x2b},
|
|
{0x3c, 0x04},
|
|
{0x3d, 0x15},
|
|
{0x4b, 0x06},
|
|
{0x4c, 0x20},
|
|
{0xfe, 0x00},
|
|
/*GAMMA*/
|
|
/*gamma1*/
|
|
{0xfe, 0x02},
|
|
{0x10, 0x09},
|
|
{0x11, 0x0d},
|
|
{0x12, 0x13},
|
|
{0x13, 0x19},
|
|
{0x14, 0x27},
|
|
{0x15, 0x37},
|
|
{0x16, 0x45},
|
|
{0x17, 0x53},
|
|
{0x18, 0x69},
|
|
{0x19, 0x7d},
|
|
{0x1a, 0x8f},
|
|
{0x1b, 0x9d},
|
|
{0x1c, 0xa9},
|
|
{0x1d, 0xbd},
|
|
{0x1e, 0xcd},
|
|
{0x1f, 0xd9},
|
|
{0x20, 0xe3},
|
|
{0x21, 0xea},
|
|
{0x22, 0xef},
|
|
{0x23, 0xf5},
|
|
{0x24, 0xf9},
|
|
{0x25, 0xff},
|
|
{0xfe, 0x00},
|
|
{0xc6, 0x20},
|
|
{0xc7, 0x2b},
|
|
/*gamma2*/
|
|
{0xfe, 0x02},
|
|
{0x26, 0x0f},
|
|
{0x27, 0x14},
|
|
{0x28, 0x19},
|
|
{0x29, 0x1e},
|
|
{0x2a, 0x27},
|
|
{0x2b, 0x33},
|
|
{0x2c, 0x3b},
|
|
{0x2d, 0x45},
|
|
{0x2e, 0x59},
|
|
{0x2f, 0x69},
|
|
{0x30, 0x7c},
|
|
{0x31, 0x89},
|
|
{0x32, 0x98},
|
|
{0x33, 0xae},
|
|
{0x34, 0xc0},
|
|
{0x35, 0xcf},
|
|
{0x36, 0xda},
|
|
{0x37, 0xe2},
|
|
{0x38, 0xe9},
|
|
{0x39, 0xf3},
|
|
{0x3a, 0xf9},
|
|
{0x3b, 0xff},
|
|
/*YCP*/
|
|
{0xfe, 0x02},
|
|
{0xd1, 0x40},
|
|
{0xd2, 0x40},
|
|
{0xd3, 0x48},
|
|
{0xd6, 0xf0},
|
|
{0xd7, 0x10},
|
|
{0xd8, 0xda},
|
|
{0xdd, 0x14},
|
|
{0xde, 0x86},
|
|
{0xed, 0x80},
|
|
{0xee, 0x00},
|
|
{0xef, 0x3f},
|
|
{0xd8, 0xd8},
|
|
/*abs*/
|
|
{0xfe, 0x01},
|
|
{0x9f, 0x40},
|
|
/*LSC*/
|
|
{0xfe, 0x01},
|
|
{0xc2, 0x14},
|
|
{0xc3, 0x0d},
|
|
{0xc4, 0x0c},
|
|
{0xc8, 0x15},
|
|
{0xc9, 0x0d},
|
|
{0xca, 0x0a},
|
|
{0xbc, 0x24},
|
|
{0xbd, 0x10},
|
|
{0xbe, 0x0b},
|
|
{0xb6, 0x25},
|
|
{0xb7, 0x16},
|
|
{0xb8, 0x15},
|
|
{0xc5, 0x00},
|
|
{0xc6, 0x00},
|
|
{0xc7, 0x00},
|
|
{0xcb, 0x00},
|
|
{0xcc, 0x00},
|
|
{0xcd, 0x00},
|
|
{0xbf, 0x07},
|
|
{0xc0, 0x00},
|
|
{0xc1, 0x00},
|
|
{0xb9, 0x00},
|
|
{0xba, 0x00},
|
|
{0xbb, 0x00},
|
|
{0xaa, 0x01},
|
|
{0xab, 0x01},
|
|
{0xac, 0x00},
|
|
{0xad, 0x05},
|
|
{0xae, 0x06},
|
|
{0xaf, 0x0e},
|
|
{0xb0, 0x0b},
|
|
{0xb1, 0x07},
|
|
{0xb2, 0x06},
|
|
{0xb3, 0x17},
|
|
{0xb4, 0x0e},
|
|
{0xb5, 0x0e},
|
|
{0xd0, 0x09},
|
|
{0xd1, 0x00},
|
|
{0xd2, 0x00},
|
|
{0xd6, 0x08},
|
|
{0xd7, 0x00},
|
|
{0xd8, 0x00},
|
|
{0xd9, 0x00},
|
|
{0xda, 0x00},
|
|
{0xdb, 0x00},
|
|
{0xd3, 0x0a},
|
|
{0xd4, 0x00},
|
|
{0xd5, 0x00},
|
|
{0xa4, 0x00},
|
|
{0xa5, 0x00},
|
|
{0xa6, 0x77},
|
|
{0xa7, 0x77},
|
|
{0xa8, 0x77},
|
|
{0xa9, 0x77},
|
|
{0xa1, 0x80},
|
|
{0xa2, 0x80},
|
|
|
|
{0xfe, 0x01},
|
|
{0xdf, 0x0d},
|
|
{0xdc, 0x25},
|
|
{0xdd, 0x30},
|
|
{0xe0, 0x77},
|
|
{0xe1, 0x80},
|
|
{0xe2, 0x77},
|
|
{0xe3, 0x90},
|
|
{0xe6, 0x90},
|
|
{0xe7, 0xa0},
|
|
{0xe8, 0x90},
|
|
{0xe9, 0xa0},
|
|
{0xfe, 0x00},
|
|
/*AWB*/
|
|
{0xfe, 0x01},
|
|
{0x4f, 0x00},
|
|
{0x4f, 0x00},
|
|
{0x4b, 0x01},
|
|
{0x4f, 0x00},
|
|
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x71},
|
|
{0x4e, 0x01},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x91},
|
|
{0x4e, 0x01},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x70},
|
|
{0x4e, 0x01},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x90},
|
|
{0x4e, 0x02},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xb0},
|
|
{0x4e, 0x02},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x8f},
|
|
{0x4e, 0x02},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x6f},
|
|
{0x4e, 0x02},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xaf},
|
|
{0x4e, 0x02},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xd0},
|
|
{0x4e, 0x02},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xf0},
|
|
{0x4e, 0x02},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xcf},
|
|
{0x4e, 0x02},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xef},
|
|
{0x4e, 0x02},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x6e},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x8e},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xae},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xce},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x4d},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x6d},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x8d},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xad},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xcd},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x4c},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x6c},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x8c},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xac},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xcc},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xcb},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x4b},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x6b},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x8b},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xab},
|
|
{0x4e, 0x03},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x8a},
|
|
{0x4e, 0x04},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xaa},
|
|
{0x4e, 0x04},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xca},
|
|
{0x4e, 0x04},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xca},
|
|
{0x4e, 0x04},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xc9},
|
|
{0x4e, 0x04},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x8a},
|
|
{0x4e, 0x04},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0x89},
|
|
{0x4e, 0x04},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xa9},
|
|
{0x4e, 0x04},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0x0b},
|
|
{0x4e, 0x05},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0x0a},
|
|
{0x4e, 0x05},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xeb},
|
|
{0x4e, 0x05},
|
|
{0x4c, 0x01},
|
|
{0x4d, 0xea},
|
|
{0x4e, 0x05},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0x09},
|
|
{0x4e, 0x05},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0x29},
|
|
{0x4e, 0x05},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0x2a},
|
|
{0x4e, 0x05},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0x4a},
|
|
{0x4e, 0x05},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0x8a},
|
|
{0x4e, 0x06},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0x49},
|
|
{0x4e, 0x06},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0x69},
|
|
{0x4e, 0x06},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0x89},
|
|
{0x4e, 0x06},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0xa9},
|
|
{0x4e, 0x06},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0x48},
|
|
{0x4e, 0x06},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0x68},
|
|
{0x4e, 0x06},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0x69},
|
|
{0x4e, 0x06},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0xca},
|
|
{0x4e, 0x07},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0xc9},
|
|
{0x4e, 0x07},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0xe9},
|
|
{0x4e, 0x07},
|
|
{0x4c, 0x03},
|
|
{0x4d, 0x09},
|
|
{0x4e, 0x07},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0xc8},
|
|
{0x4e, 0x07},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0xe8},
|
|
{0x4e, 0x07},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0xa7},
|
|
{0x4e, 0x07},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0xc7},
|
|
{0x4e, 0x07},
|
|
{0x4c, 0x02},
|
|
{0x4d, 0xe7},
|
|
{0x4e, 0x07},
|
|
{0x4c, 0x03},
|
|
{0x4d, 0x07},
|
|
{0x4e, 0x07},
|
|
|
|
{0x4f, 0x01},
|
|
{0x50, 0x80},
|
|
{0x51, 0xa8},
|
|
{0x52, 0x47},
|
|
{0x53, 0x38},
|
|
{0x54, 0xc7},
|
|
{0x56, 0x0e},
|
|
{0x58, 0x08},
|
|
{0x5b, 0x00},
|
|
{0x5c, 0x74},
|
|
{0x5d, 0x8b},
|
|
{0x61, 0xdb},
|
|
{0x62, 0xb8},
|
|
{0x63, 0x86},
|
|
{0x64, 0xc0},
|
|
{0x65, 0x04},
|
|
{0x67, 0xa8},
|
|
{0x68, 0xb0},
|
|
{0x69, 0x00},
|
|
{0x6a, 0xa8},
|
|
{0x6b, 0xb0},
|
|
{0x6c, 0xaf},
|
|
{0x6d, 0x8b},
|
|
{0x6e, 0x50},
|
|
{0x6f, 0x18},
|
|
{0x73, 0xf0},
|
|
{0x70, 0x0d},
|
|
{0x71, 0x60},
|
|
{0x72, 0x80},
|
|
{0x74, 0x01},
|
|
{0x75, 0x01},
|
|
{0x7f, 0x0c},
|
|
{0x76, 0x70},
|
|
{0x77, 0x58},
|
|
{0x78, 0xa0},
|
|
{0x79, 0x5e},
|
|
{0x7a, 0x54},
|
|
{0x7b, 0x58},
|
|
{0xfe, 0x00},
|
|
/*CC*/
|
|
{0xfe, 0x02},
|
|
{0xc0, 0x01},
|
|
{0xc1, 0x44},
|
|
{0xc2, 0xfd},
|
|
{0xc3, 0x04},
|
|
{0xc4, 0xF0},
|
|
{0xc5, 0x48},
|
|
{0xc6, 0xfd},
|
|
{0xc7, 0x46},
|
|
{0xc8, 0xfd},
|
|
{0xc9, 0x02},
|
|
{0xca, 0xe0},
|
|
{0xcb, 0x45},
|
|
{0xcc, 0xec},
|
|
{0xcd, 0x48},
|
|
{0xce, 0xf0},
|
|
{0xcf, 0xf0},
|
|
{0xe3, 0x0c},
|
|
{0xe4, 0x4b},
|
|
{0xe5, 0xe0},
|
|
/*ABS*/
|
|
{0xfe, 0x01},
|
|
{0x9f, 0x40},
|
|
{0xfe, 0x00},
|
|
/*OUTPUT*/
|
|
{0xfe, 0x00},
|
|
{0xf2, 0x0f},
|
|
/*dark sun*/
|
|
{0xfe, 0x02},
|
|
{0x40, 0xbf},
|
|
{0x46, 0xcf},
|
|
{0xfe, 0x00},
|
|
|
|
/*frame rate 50Hz*/
|
|
{0xfe, 0x00},
|
|
{0x05, 0x02},
|
|
{0x06, 0x20},
|
|
{0x07, 0x00},
|
|
{0x08, 0x32},
|
|
{0xfe, 0x01},
|
|
{0x25, 0x00},
|
|
{0x26, 0xfa},
|
|
|
|
{0x27, 0x04},
|
|
{0x28, 0xe2},
|
|
{0x29, 0x04},
|
|
{0x2a, 0xe2},
|
|
{0x2b, 0x04},
|
|
{0x2c, 0xe2},
|
|
{0x2d, 0x04},
|
|
{0x2e, 0xe2},
|
|
{0xfe, 0x00},
|
|
|
|
{0xfe, 0x00},
|
|
{0xfd, 0x01},
|
|
{0xfa, 0x00},
|
|
/*crop window*/
|
|
{0xfe, 0x00},
|
|
{0x90, 0x01},
|
|
{0x91, 0x00},
|
|
{0x92, 0x00},
|
|
{0x93, 0x00},
|
|
{0x94, 0x00},
|
|
{0x95, 0x02},
|
|
{0x96, 0x58},
|
|
{0x97, 0x03},
|
|
{0x98, 0x20},
|
|
{0x99, 0x11},
|
|
{0x9a, 0x06},
|
|
/*AWB*/
|
|
{0xfe, 0x00},
|
|
{0xec, 0x02},
|
|
{0xed, 0x02},
|
|
{0xee, 0x30},
|
|
{0xef, 0x48},
|
|
{0xfe, 0x02},
|
|
{0x9d, 0x08},
|
|
{0xfe, 0x01},
|
|
{0x74, 0x00},
|
|
/*AEC*/
|
|
{0xfe, 0x01},
|
|
{0x01, 0x04},
|
|
{0x02, 0x60},
|
|
{0x03, 0x02},
|
|
{0x04, 0x48},
|
|
{0x05, 0x18},
|
|
{0x06, 0x50},
|
|
{0x07, 0x10},
|
|
{0x08, 0x38},
|
|
{0x0a, 0x80},
|
|
{0x21, 0x04},
|
|
{0xfe, 0x00},
|
|
{0x20, 0x03},
|
|
{0xfe, 0x00},
|
|
|
|
{0xfe, 0x00},
|
|
{0x05, 0x02},
|
|
{0x06, 0x20},
|
|
{0x07, 0x00},
|
|
{0x08, 0x50},
|
|
{0xfe, 0x01},
|
|
{0x25, 0x00},
|
|
{0x26, 0xfa},
|
|
|
|
{0x27, 0x04},
|
|
{0x28, 0xe2},
|
|
{0x29, 0x04},
|
|
{0x2a, 0xe2},
|
|
{0x2b, 0x04},
|
|
{0x2c, 0xe2},
|
|
{0x2d, 0x04},
|
|
{0x2e, 0xe2},
|
|
|
|
{0xfe, 0x00},
|
|
{0xb6, 0x01},
|
|
{0xfd, 0x01},
|
|
{0xfa, 0x00},
|
|
{0x18, 0x22},
|
|
/*crop window*/
|
|
{0xfe, 0x00},
|
|
{0x90, 0x01},
|
|
{0x91, 0x00},
|
|
{0x92, 0x00},
|
|
{0x93, 0x00},
|
|
{0x94, 0x00},
|
|
{0x95, 0x02},
|
|
{0x96, 0x58},
|
|
{0x97, 0x03},
|
|
{0x98, 0x20},
|
|
{0x99, 0x11},
|
|
{0x9a, 0x06},
|
|
/*AWB*/
|
|
{0xfe, 0x00},
|
|
{0xec, 0x02},
|
|
{0xed, 0x02},
|
|
{0xee, 0x30},
|
|
{0xef, 0x48},
|
|
{0xfe, 0x02},
|
|
{0x9d, 0x08},
|
|
{0xfe, 0x01},
|
|
{0x74, 0x00},
|
|
/*AEC*/
|
|
{0xfe, 0x01},
|
|
{0x01, 0x04},
|
|
{0x02, 0x60},
|
|
{0x03, 0x02},
|
|
{0x04, 0x48},
|
|
{0x05, 0x18},
|
|
{0x06, 0x50},
|
|
{0x07, 0x10},
|
|
{0x08, 0x38},
|
|
{0x0a, 0x80},
|
|
{0x21, 0x04},
|
|
{0xfe, 0x00},
|
|
{0x20, 0x03},
|
|
{0xfe, 0x00},
|
|
SensorEnd
|
|
};
|
|
|
|
static void gc2145_reinit_parameter(struct vehicle_ad_dev *ad, unsigned char cvstd)
|
|
{
|
|
int i = 0;
|
|
|
|
switch (cvstd) {
|
|
case CVSTD_PAL:
|
|
case CVSTD_NTSC:
|
|
case CVSTD_SVGAP30:
|
|
default:
|
|
ad->cfg.width = 800;
|
|
ad->cfg.height = 600;
|
|
ad->cfg.start_x = 0;
|
|
ad->cfg.start_y = 0;
|
|
ad->cfg.input_format = CIF_INPUT_FORMAT_YUV;
|
|
ad->cfg.output_format = FORCE_CIF_OUTPUT_FORMAT;
|
|
ad->cfg.field_order = 0;
|
|
ad->cfg.yuv_order = 0;/*00 - UYVY*/
|
|
ad->cfg.href = 0;
|
|
ad->cfg.vsync = 0;
|
|
ad->cfg.frame_rate = 30;
|
|
ad->cfg.type = V4L2_MBUS_PARALLEL;
|
|
ad->cfg.mbus_flags = V4L2_MBUS_HSYNC_ACTIVE_HIGH |
|
|
V4L2_MBUS_VSYNC_ACTIVE_LOW |
|
|
V4L2_MBUS_PCLK_SAMPLE_RISING;
|
|
break;
|
|
}
|
|
|
|
/* fix crop info from dts config */
|
|
for (i = 0; i < 4; i++) {
|
|
if ((ad->defrects[i].width == ad->cfg.width) &&
|
|
(ad->defrects[i].height == ad->cfg.height)) {
|
|
ad->cfg.start_x = ad->defrects[i].crop_x;
|
|
ad->cfg.start_y = ad->defrects[i].crop_y;
|
|
ad->cfg.width = ad->defrects[i].crop_width;
|
|
ad->cfg.height = ad->defrects[i].crop_height;
|
|
}
|
|
}
|
|
|
|
#ifdef CVBS_DOUBLE_FPS_MODE
|
|
#endif
|
|
SENSOR_DG("%s,crop(%d,%d)", __func__, ad->cfg.start_x, ad->cfg.start_y);
|
|
}
|
|
|
|
static void gc2145_reg_init(struct vehicle_ad_dev *ad, unsigned char cvstd)
|
|
{
|
|
struct rk_sensor_reg *sensor;
|
|
int i;
|
|
unsigned char val[2];
|
|
|
|
switch (cvstd) {
|
|
case CVSTD_SVGAP30:
|
|
sensor = sensor_preview_data_svga_30hz;
|
|
break;
|
|
default:
|
|
sensor = sensor_preview_data_svga_30hz;
|
|
break;
|
|
}
|
|
i = 0;
|
|
while ((sensor[i].reg != SEQCMD_END) && (sensor[i].reg != 0xFC000000)) {
|
|
if (sensor[i].reg == SENSOR_CHANNEL_REG)
|
|
sensor[i].val = ad->ad_chl;
|
|
|
|
val[0] = sensor[i].val;
|
|
vehicle_generic_sensor_write(ad, sensor[i].reg, val);
|
|
i++;
|
|
}
|
|
}
|
|
|
|
void gc2145_channel_set(struct vehicle_ad_dev *ad, int channel)
|
|
{
|
|
unsigned int reg = 0x41;
|
|
unsigned char val[0];
|
|
|
|
val[0] = channel;
|
|
ad->ad_chl = channel;
|
|
|
|
vehicle_generic_sensor_write(ad, reg, val);
|
|
}
|
|
|
|
int gc2145_ad_get_cfg(struct vehicle_cfg **cfg)
|
|
{
|
|
if (!gc2145_g_addev)
|
|
return -1;
|
|
|
|
switch (cvstd_state) {
|
|
case VIDEO_UNPLUG:
|
|
gc2145_g_addev->cfg.ad_ready = false;
|
|
break;
|
|
case VIDEO_LOCKED:
|
|
gc2145_g_addev->cfg.ad_ready = true;
|
|
break;
|
|
case VIDEO_IN:
|
|
gc2145_g_addev->cfg.ad_ready = false;
|
|
break;
|
|
}
|
|
|
|
gc2145_g_addev->cfg.ad_ready = true;
|
|
*cfg = &gc2145_g_addev->cfg;
|
|
|
|
return 0;
|
|
}
|
|
|
|
void gc2145_ad_check_cif_error(struct vehicle_ad_dev *ad, int last_line)
|
|
{
|
|
SENSOR_DG("%s, last_line %d\n", __func__, last_line);
|
|
|
|
if (last_line < 1)
|
|
return;
|
|
|
|
ad->cif_error_last_line = last_line;
|
|
if (cvstd_mode == CVSTD_PAL) {
|
|
if (last_line == FORCE_NTSC_HEIGHT) {
|
|
if (ad->state_check_work.state_check_wq)
|
|
queue_delayed_work(
|
|
ad->state_check_work.state_check_wq,
|
|
&ad->state_check_work.work,
|
|
msecs_to_jiffies(0));
|
|
}
|
|
} else if (cvstd_mode == CVSTD_NTSC) {
|
|
if (last_line == FORCE_PAL_HEIGHT) {
|
|
if (ad->state_check_work.state_check_wq)
|
|
queue_delayed_work(
|
|
ad->state_check_work.state_check_wq,
|
|
&ad->state_check_work.work,
|
|
msecs_to_jiffies(0));
|
|
}
|
|
} else if (cvstd_mode == CVSTD_SVGAP30) {
|
|
if (last_line == FORCE_SVGA_HEIGHT) {
|
|
if (ad->state_check_work.state_check_wq)
|
|
queue_delayed_work(
|
|
ad->state_check_work.state_check_wq,
|
|
&ad->state_check_work.work,
|
|
msecs_to_jiffies(0));
|
|
}
|
|
}
|
|
}
|
|
|
|
int gc2145_check_id(struct vehicle_ad_dev *ad)
|
|
{
|
|
int ret = 0;
|
|
int pidh, pidl;
|
|
unsigned short id;
|
|
|
|
pidh = vehicle_generic_sensor_read(ad, 0xf0);
|
|
pidl = vehicle_generic_sensor_read(ad, 0xf1);
|
|
if (pidh != 0x21 || pidl != 0x45) {
|
|
SENSOR_DG("%s: expected 0x2145, detected 0x%02x 0x%02x\n",
|
|
ad->ad_name, pidh, pidl);
|
|
ret = -EINVAL;
|
|
} else {
|
|
id = SENSOR_ID(pidh, pidl);
|
|
SENSOR_DG("%s Found GC%04X sensor OK!\n", __func__, id);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int gc2145_check_cvstd(struct vehicle_ad_dev *ad, bool activate_check)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
int gc2145_stream(struct vehicle_ad_dev *ad, int enable)
|
|
{
|
|
char val;
|
|
|
|
SENSOR_DG("%s on(%d)\n", __func__, enable);
|
|
|
|
if (enable)
|
|
val = 0x0f; //stream on
|
|
else
|
|
val = 0x00; //stream off
|
|
vehicle_generic_sensor_write(ad, 0xf2, &val);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void power_on(struct vehicle_ad_dev *ad)
|
|
{
|
|
/* gpio_direction_output(ad->power, ad->pwr_active); */
|
|
SENSOR_DG("gpio: power(%d), powerdown(%d)", ad->power, ad->powerdown);
|
|
if (gpio_is_valid(ad->power)) {
|
|
gpio_request(ad->power, "ad_power");
|
|
gpio_direction_output(ad->power, ad->pwr_active);
|
|
/* gpio_set_value(ad->power, ad->pwr_active); */
|
|
}
|
|
|
|
if (gpio_is_valid(ad->powerdown)) {
|
|
gpio_request(ad->powerdown, "ad_powerdown");
|
|
gpio_direction_output(ad->powerdown, !ad->pwdn_active);
|
|
/* gpio_set_value(ad->powerdown, !ad->pwdn_active); */
|
|
}
|
|
}
|
|
|
|
static void power_off(struct vehicle_ad_dev *ad)
|
|
{
|
|
if (gpio_is_valid(ad->power))
|
|
gpio_free(ad->power);
|
|
if (gpio_is_valid(ad->powerdown))
|
|
gpio_free(ad->powerdown);
|
|
}
|
|
|
|
static void gc2145_check_state_work(struct work_struct *work)
|
|
{
|
|
struct vehicle_ad_dev *ad;
|
|
static bool is_first = true;
|
|
|
|
ad = gc2145_g_addev;
|
|
|
|
if (ad->cif_error_last_line > 0) {
|
|
gc2145_check_cvstd(ad, true);
|
|
ad->cif_error_last_line = 0;
|
|
} else {
|
|
gc2145_check_cvstd(ad, false);
|
|
}
|
|
|
|
if (is_first) {
|
|
SENSOR_DG("%s:cvstd_old(%d), cvstd_mode(%d)\n", __func__, cvstd_old, cvstd_mode);
|
|
is_first = false;
|
|
}
|
|
|
|
if (cvstd_old != cvstd_mode || cvstd_old_state != cvstd_state) {
|
|
SENSOR_DG("%s:ad sensor std mode change, cvstd_old(%d), cvstd_mode(%d)\n",
|
|
__func__, cvstd_old, cvstd_mode);
|
|
cvstd_old = cvstd_mode;
|
|
cvstd_old_state = cvstd_state;
|
|
SENSOR_DG("ad signal change notify\n");
|
|
vehicle_ad_stat_change_notify();
|
|
}
|
|
|
|
queue_delayed_work(ad->state_check_work.state_check_wq,
|
|
&ad->state_check_work.work, msecs_to_jiffies(100));
|
|
}
|
|
|
|
int gc2145_ad_deinit(void)
|
|
{
|
|
struct vehicle_ad_dev *ad;
|
|
|
|
ad = gc2145_g_addev;
|
|
|
|
if (!ad)
|
|
return -1;
|
|
|
|
if (ad->state_check_work.state_check_wq) {
|
|
cancel_delayed_work_sync(&ad->state_check_work.work);
|
|
flush_delayed_work(&ad->state_check_work.work);
|
|
flush_workqueue(ad->state_check_work.state_check_wq);
|
|
destroy_workqueue(ad->state_check_work.state_check_wq);
|
|
}
|
|
if (ad->irq)
|
|
free_irq(ad->irq, ad);
|
|
power_off(ad);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static __maybe_unused int get_ad_mode_from_fix_format(int fix_format)
|
|
{
|
|
int mode = -1;
|
|
|
|
switch (fix_format) {
|
|
case AD_FIX_FORMAT_PAL:
|
|
case AD_FIX_FORMAT_NTSC:
|
|
case AD_FIX_FORMAT_720P_50FPS:
|
|
case AD_FIX_FORMAT_720P_30FPS:
|
|
case AD_FIX_FORMAT_720P_25FPS:
|
|
default:
|
|
mode = CVSTD_SVGAP30;
|
|
break;
|
|
}
|
|
|
|
return mode;
|
|
}
|
|
|
|
int gc2145_ad_init(struct vehicle_ad_dev *ad)
|
|
{
|
|
int val;
|
|
int i = 0;
|
|
|
|
gc2145_g_addev = ad;
|
|
|
|
/* 1. i2c init */
|
|
while (ad->adapter == NULL) {
|
|
ad->adapter = i2c_get_adapter(ad->i2c_chl);
|
|
usleep_range(10000, 12000);
|
|
}
|
|
if (ad->adapter == NULL)
|
|
return -ENODEV;
|
|
|
|
if (!i2c_check_functionality(ad->adapter, I2C_FUNC_I2C))
|
|
return -EIO;
|
|
|
|
/* 2. ad power on sequence */
|
|
power_on(ad);
|
|
|
|
while (++i < 5) {
|
|
usleep_range(1000, 1200);
|
|
val = vehicle_generic_sensor_read(ad, 0xf0);
|
|
if (val != 0xff)
|
|
break;
|
|
SENSOR_DG("gc2145_init i2c_reg_read fail\n");
|
|
}
|
|
|
|
/* 3 .init default format params */
|
|
gc2145_reg_init(ad, cvstd_mode);
|
|
gc2145_reinit_parameter(ad, cvstd_mode);
|
|
SENSOR_DG("%s after reinit init\n", __func__);
|
|
|
|
/* 5. create workqueue to detect signal change */
|
|
INIT_DELAYED_WORK(&ad->state_check_work.work, gc2145_check_state_work);
|
|
ad->state_check_work.state_check_wq =
|
|
create_singlethread_workqueue("vehicle-ad-gc2145");
|
|
|
|
/* gc2145_check_cvstd(ad, true); */
|
|
|
|
queue_delayed_work(ad->state_check_work.state_check_wq,
|
|
&ad->state_check_work.work, msecs_to_jiffies(100));
|
|
|
|
return 0;
|
|
}
|
|
|
|
|