436 lines
13 KiB
C
436 lines
13 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* techpoint lib
|
|
*
|
|
* Copyright (C) 2023 Rockchip Electronics Co., Ltd.
|
|
*/
|
|
|
|
#include "techpoint_tp9950.h"
|
|
#include "techpoint_dev.h"
|
|
|
|
static struct techpoint_video_modes supported_modes[] = {
|
|
#if TP9950_DEF_PAL
|
|
{
|
|
.bus_fmt = MEDIA_BUS_FMT_UYVY8_2X8,
|
|
.width = 960,
|
|
.height = 576,
|
|
.max_fps = {
|
|
.numerator = 10000,
|
|
.denominator = 250000,
|
|
},
|
|
.link_freq_value = TP9950_LINK_FREQ_148M,
|
|
.common_reg_list = NULL,
|
|
.common_reg_size = 0,
|
|
.bpp = TP9950_BITS_PER_SAMPLE,
|
|
.lane = TP9950_LANES,
|
|
.vc[PAD0] = 0,
|
|
.vc[PAD1] = 1,
|
|
.vc[PAD2] = 2,
|
|
.vc[PAD3] = 3,
|
|
},
|
|
#endif
|
|
#if TP9950_DEF_NTSC
|
|
{
|
|
.bus_fmt = MEDIA_BUS_FMT_UYVY8_2X8,
|
|
.width = 960,
|
|
.height = 480,
|
|
.max_fps = {
|
|
.numerator = 10000,
|
|
.denominator = 250000,
|
|
},
|
|
.link_freq_value = TP9950_LINK_FREQ_148M,
|
|
.common_reg_list = NULL,
|
|
.common_reg_size = 0,
|
|
.bpp = TP9950_BITS_PER_SAMPLE,
|
|
.lane = TP9950_LANES,
|
|
.vc[PAD0] = 0,
|
|
.vc[PAD1] = 1,
|
|
.vc[PAD2] = 2,
|
|
.vc[PAD3] = 3,
|
|
},
|
|
#endif
|
|
#if TP9950_DEF_1080P
|
|
{
|
|
.bus_fmt = MEDIA_BUS_FMT_UYVY8_2X8,
|
|
.width = 1920,
|
|
.height = 1080,
|
|
.max_fps = {
|
|
.numerator = 10000,
|
|
.denominator = 250000,
|
|
},
|
|
.link_freq_value = TP9950_LINK_FREQ_594M,
|
|
.link_freq_value = TP9950_LINK_FREQ_297M,
|
|
.common_reg_list = NULL,
|
|
.common_reg_size = 0,
|
|
.bpp = TP9950_BITS_PER_SAMPLE,
|
|
.lane = TP9950_LANES,
|
|
.vc[PAD0] = 0,
|
|
.vc[PAD1] = 1,
|
|
.vc[PAD2] = 2,
|
|
.vc[PAD3] = 3,
|
|
},
|
|
#endif
|
|
#if TP9950_DEF_720P
|
|
{
|
|
.bus_fmt = MEDIA_BUS_FMT_UYVY8_2X8,
|
|
.width = 1280,
|
|
.height = 720,
|
|
.max_fps = {
|
|
.numerator = 10000,
|
|
.denominator = 250000,
|
|
},
|
|
.link_freq_value = TP9950_LINK_FREQ_297M,
|
|
.common_reg_list = NULL,
|
|
.common_reg_size = 0,
|
|
.bpp = TP9950_BITS_PER_SAMPLE,
|
|
.lane = TP9950_LANES,
|
|
.vc[PAD0] = 0,
|
|
.vc[PAD1] = 1,
|
|
.vc[PAD2] = 2,
|
|
.vc[PAD3] = 3,
|
|
},
|
|
#endif
|
|
};
|
|
|
|
int tp9950_initialize(struct techpoint *techpoint)
|
|
{
|
|
int array_size = 0;
|
|
struct i2c_client *client = techpoint->client;
|
|
struct device *dev = &client->dev;
|
|
|
|
techpoint->video_modes_num = ARRAY_SIZE(supported_modes);
|
|
array_size =
|
|
sizeof(struct techpoint_video_modes) * techpoint->video_modes_num;
|
|
techpoint->video_modes = devm_kzalloc(dev, array_size, GFP_KERNEL);
|
|
memcpy(techpoint->video_modes, supported_modes, array_size);
|
|
|
|
techpoint->cur_video_mode = &techpoint->video_modes[0];
|
|
|
|
return 0;
|
|
}
|
|
|
|
int tp9950_get_channel_input_status(struct i2c_client *client, u8 ch)
|
|
{
|
|
u8 val = 0;
|
|
|
|
techpoint_write_reg(client, PAGE_REG, ch);
|
|
techpoint_read_reg(client, INPUT_STATUS_REG, &val);
|
|
dev_dbg(&client->dev, "input_status ch %d : %x\n", ch, val);
|
|
|
|
return (val & INPUT_STATUS_MASK) ? 0 : 1;
|
|
}
|
|
|
|
int tp9950_get_all_input_status(struct i2c_client *client, u8 *detect_status)
|
|
{
|
|
u8 val = 0, i;
|
|
|
|
for (i = 0; i < PAD_MAX; i++) {
|
|
techpoint_write_reg(client, PAGE_REG, i);
|
|
techpoint_read_reg(client, INPUT_STATUS_REG, &val);
|
|
detect_status[i] = tp9950_get_channel_input_status(client, i);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int tp9950_set_channel_reso(struct i2c_client *client, int ch,
|
|
enum techpoint_support_reso reso)
|
|
{
|
|
int val = reso;
|
|
|
|
dev_info(&client->dev, "##$$ %s", __func__);
|
|
techpoint_write_reg(client, 0x41, 0x00);
|
|
techpoint_write_reg(client, 0x40, 0x08);
|
|
techpoint_write_reg(client, 0x01, 0xf8);
|
|
techpoint_write_reg(client, 0x02, 0x01);
|
|
techpoint_write_reg(client, 0x08, 0x03);
|
|
techpoint_write_reg(client, 0x20, 0x12);
|
|
techpoint_write_reg(client, 0x39, 0x00);
|
|
|
|
techpoint_write_reg(client, 0x40, 0x00);
|
|
techpoint_write_reg(client, 0x4c, 0x40);
|
|
techpoint_write_reg(client, 0x4e, 0x00);
|
|
techpoint_write_reg(client, 0x27, 0x2d);
|
|
techpoint_write_reg(client, 0xfd, 0x80);
|
|
|
|
switch (val) {
|
|
case TECHPOINT_S_RESO_720P_25:
|
|
#if TP9950_DEF_720P
|
|
default:
|
|
#endif
|
|
dev_err(&client->dev, "set channel 720P_25\n");
|
|
techpoint_write_reg(client, 0x02, 0x42);
|
|
techpoint_write_reg(client, 0x07, 0xc0);
|
|
techpoint_write_reg(client, 0x0b, 0xc0);
|
|
techpoint_write_reg(client, 0x0c, 0x13);
|
|
techpoint_write_reg(client, 0x0d, 0x50);
|
|
techpoint_write_reg(client, 0x15, 0x13);
|
|
techpoint_write_reg(client, 0x16, 0x15);
|
|
techpoint_write_reg(client, 0x17, 0x00);
|
|
techpoint_write_reg(client, 0x18, 0x19);
|
|
techpoint_write_reg(client, 0x19, 0xd0);
|
|
techpoint_write_reg(client, 0x1a, 0x25);
|
|
techpoint_write_reg(client, 0x1c, 0x07);//1280*720, 25fps
|
|
techpoint_write_reg(client, 0x1d, 0xbc);//1280*720, 25fps
|
|
techpoint_write_reg(client, 0x20, 0x30);
|
|
techpoint_write_reg(client, 0x21, 0x84);
|
|
techpoint_write_reg(client, 0x22, 0x36);
|
|
techpoint_write_reg(client, 0x23, 0x3c);
|
|
techpoint_write_reg(client, 0x2b, 0x60);
|
|
techpoint_write_reg(client, 0x2c, 0x0a);
|
|
techpoint_write_reg(client, 0x2d, 0x30);
|
|
techpoint_write_reg(client, 0x2e, 0x70);
|
|
techpoint_write_reg(client, 0x30, 0x48);
|
|
techpoint_write_reg(client, 0x31, 0xbb);
|
|
techpoint_write_reg(client, 0x32, 0x2e);
|
|
techpoint_write_reg(client, 0x33, 0x90);
|
|
techpoint_write_reg(client, 0x35, 0x25);
|
|
techpoint_write_reg(client, 0x38, 0x00);
|
|
techpoint_write_reg(client, 0x39, 0x18);
|
|
if (STD_HDA) {
|
|
techpoint_write_reg(client, 0x02, 0x46);
|
|
techpoint_write_reg(client, 0x0d, 0x71);
|
|
techpoint_write_reg(client, 0x18, 0x1b);
|
|
techpoint_write_reg(client, 0x20, 0x40);
|
|
techpoint_write_reg(client, 0x21, 0x46);
|
|
techpoint_write_reg(client, 0x25, 0xfe);
|
|
techpoint_write_reg(client, 0x26, 0x01);
|
|
techpoint_write_reg(client, 0x2c, 0x3a);
|
|
techpoint_write_reg(client, 0x2d, 0x5a);
|
|
techpoint_write_reg(client, 0x2e, 0x40);
|
|
techpoint_write_reg(client, 0x30, 0x9e);
|
|
techpoint_write_reg(client, 0x31, 0x20);
|
|
techpoint_write_reg(client, 0x32, 0x10);
|
|
techpoint_write_reg(client, 0x33, 0x90);
|
|
}
|
|
techpoint_write_reg(client, 0x40, 0x08);
|
|
techpoint_write_reg(client, 0x23, 0x02);
|
|
techpoint_write_reg(client, 0x13, 0x24);
|
|
techpoint_write_reg(client, 0x14, 0x46);
|
|
techpoint_write_reg(client, 0x15, 0x09);
|
|
techpoint_write_reg(client, 0x25, 0x08);
|
|
techpoint_write_reg(client, 0x26, 0x01);
|
|
techpoint_write_reg(client, 0x27, 0x0e);
|
|
techpoint_write_reg(client, 0x10, 0x88);
|
|
techpoint_write_reg(client, 0x10, 0x08);
|
|
techpoint_write_reg(client, 0x23, 0x00);
|
|
techpoint_write_reg(client, 0x40, 0x00);
|
|
break;
|
|
case TECHPOINT_S_RESO_1080P_25:
|
|
#if TP9950_DEF_1080P
|
|
default:
|
|
#endif
|
|
dev_err(&client->dev, "set channel 1080P_25\n");
|
|
techpoint_write_reg(client, 0x02, 0x40);
|
|
techpoint_write_reg(client, 0x07, 0xc0);
|
|
techpoint_write_reg(client, 0x0b, 0xc0);
|
|
techpoint_write_reg(client, 0x0c, 0x03);
|
|
techpoint_write_reg(client, 0x0d, 0x50);
|
|
techpoint_write_reg(client, 0x15, 0x03);
|
|
techpoint_write_reg(client, 0x16, 0xd2);
|
|
techpoint_write_reg(client, 0x17, 0x80);
|
|
techpoint_write_reg(client, 0x18, 0x29);
|
|
techpoint_write_reg(client, 0x19, 0x38);
|
|
techpoint_write_reg(client, 0x1a, 0x47);
|
|
techpoint_write_reg(client, 0x1c, 0x0a);//1920*1080, 25fps
|
|
techpoint_write_reg(client, 0x1d, 0x50);//
|
|
techpoint_write_reg(client, 0x20, 0x30);
|
|
techpoint_write_reg(client, 0x21, 0x84);
|
|
techpoint_write_reg(client, 0x22, 0x36);
|
|
techpoint_write_reg(client, 0x23, 0x3c);
|
|
techpoint_write_reg(client, 0x2b, 0x60);
|
|
techpoint_write_reg(client, 0x2c, 0x0a);
|
|
techpoint_write_reg(client, 0x2d, 0x30);
|
|
techpoint_write_reg(client, 0x2e, 0x70);
|
|
techpoint_write_reg(client, 0x30, 0x48);
|
|
techpoint_write_reg(client, 0x31, 0xbb);
|
|
techpoint_write_reg(client, 0x32, 0x2e);
|
|
techpoint_write_reg(client, 0x33, 0x90);
|
|
techpoint_write_reg(client, 0x35, 0x05);
|
|
techpoint_write_reg(client, 0x38, 0x00);
|
|
techpoint_write_reg(client, 0x39, 0x1C);
|
|
if (STD_HDA) {
|
|
techpoint_write_reg(client, 0x02, 0x44);
|
|
techpoint_write_reg(client, 0x0d, 0x73);
|
|
techpoint_write_reg(client, 0x15, 0x01);
|
|
techpoint_write_reg(client, 0x16, 0xf0);
|
|
techpoint_write_reg(client, 0x18, 0x2a);
|
|
techpoint_write_reg(client, 0x20, 0x3c);
|
|
techpoint_write_reg(client, 0x21, 0x46);
|
|
techpoint_write_reg(client, 0x25, 0xfe);
|
|
techpoint_write_reg(client, 0x26, 0x0d);
|
|
techpoint_write_reg(client, 0x2c, 0x3a);
|
|
techpoint_write_reg(client, 0x2d, 0x54);
|
|
techpoint_write_reg(client, 0x2e, 0x40);
|
|
techpoint_write_reg(client, 0x30, 0xa5);
|
|
techpoint_write_reg(client, 0x31, 0x86);
|
|
techpoint_write_reg(client, 0x32, 0xfb);
|
|
techpoint_write_reg(client, 0x33, 0x60);
|
|
}
|
|
techpoint_write_reg(client, 0x40, 0x08);
|
|
techpoint_write_reg(client, 0x23, 0x02);
|
|
techpoint_write_reg(client, 0x13, 0x04);
|
|
techpoint_write_reg(client, 0x14, 0x46);
|
|
techpoint_write_reg(client, 0x15, 0x09);
|
|
techpoint_write_reg(client, 0x25, 0x08);
|
|
techpoint_write_reg(client, 0x26, 0x04);
|
|
techpoint_write_reg(client, 0x27, 0x0c);
|
|
techpoint_write_reg(client, 0x10, 0x88);
|
|
techpoint_write_reg(client, 0x10, 0x08);
|
|
techpoint_write_reg(client, 0x23, 0x00);
|
|
techpoint_write_reg(client, 0x40, 0x00);
|
|
/* techpoint_write_reg(client, 0x41, 0xc0); */
|
|
break;
|
|
case TECHPOINT_S_RESO_PAL:
|
|
#if TP9950_DEF_PAL
|
|
default:
|
|
#endif
|
|
dev_err(&client->dev, "set channel PAL\n");
|
|
techpoint_write_reg(client, 0x02, 0x47);
|
|
techpoint_write_reg(client, 0x07, 0x80);
|
|
techpoint_write_reg(client, 0x0b, 0x80);
|
|
techpoint_write_reg(client, 0x0c, 0x13);
|
|
techpoint_write_reg(client, 0x0d, 0x51);
|
|
techpoint_write_reg(client, 0x15, 0x13);
|
|
techpoint_write_reg(client, 0x16, 0x76);
|
|
techpoint_write_reg(client, 0x17, 0x80);
|
|
techpoint_write_reg(client, 0x18, 0x17);
|
|
techpoint_write_reg(client, 0x19, 0x20);
|
|
techpoint_write_reg(client, 0x1a, 0x17);
|
|
techpoint_write_reg(client, 0x1c, 0x09);
|
|
techpoint_write_reg(client, 0x1d, 0x48);
|
|
techpoint_write_reg(client, 0x20, 0x48);
|
|
techpoint_write_reg(client, 0x21, 0x84);
|
|
techpoint_write_reg(client, 0x22, 0x37);
|
|
techpoint_write_reg(client, 0x23, 0x3f);
|
|
techpoint_write_reg(client, 0x2b, 0x70);
|
|
techpoint_write_reg(client, 0x2c, 0x2a);
|
|
techpoint_write_reg(client, 0x2d, 0x64);
|
|
techpoint_write_reg(client, 0x2e, 0x56);
|
|
techpoint_write_reg(client, 0x30, 0x7a);
|
|
techpoint_write_reg(client, 0x31, 0x4a);
|
|
techpoint_write_reg(client, 0x32, 0x4d);
|
|
techpoint_write_reg(client, 0x33, 0xf0);
|
|
techpoint_write_reg(client, 0x35, 0x65);
|
|
techpoint_write_reg(client, 0x38, 0x00);
|
|
techpoint_write_reg(client, 0x39, 0x04);
|
|
techpoint_write_reg(client, 0x40, 0x08);
|
|
techpoint_write_reg(client, 0x23, 0x02);
|
|
techpoint_write_reg(client, 0x13, 0x24);
|
|
techpoint_write_reg(client, 0x14, 0x57);
|
|
techpoint_write_reg(client, 0x15, 0x0e);
|
|
techpoint_write_reg(client, 0x25, 0x02);
|
|
techpoint_write_reg(client, 0x26, 0x00);
|
|
techpoint_write_reg(client, 0x27, 0x03);
|
|
techpoint_write_reg(client, 0x10, 0x88);
|
|
techpoint_write_reg(client, 0x10, 0x08);
|
|
techpoint_write_reg(client, 0x23, 0x00);
|
|
techpoint_write_reg(client, 0x40, 0x00);
|
|
break;
|
|
case TECHPOINT_S_RESO_NTSC:
|
|
#if TP9950_DEF_NTSC
|
|
default:
|
|
#endif
|
|
dev_err(&client->dev, "set channel NTSC\n");
|
|
techpoint_write_reg(client, 0x02, 0x47);
|
|
techpoint_write_reg(client, 0x07, 0x80);
|
|
techpoint_write_reg(client, 0x0b, 0x80);
|
|
techpoint_write_reg(client, 0x0c, 0x13);
|
|
techpoint_write_reg(client, 0x0d, 0x50);
|
|
|
|
techpoint_write_reg(client, 0x15, 0x13);
|
|
techpoint_write_reg(client, 0x16, 0x60);
|
|
techpoint_write_reg(client, 0x17, 0x80);
|
|
techpoint_write_reg(client, 0x18, 0x12);
|
|
techpoint_write_reg(client, 0x19, 0xf0);
|
|
techpoint_write_reg(client, 0x1a, 0x07);
|
|
techpoint_write_reg(client, 0x1c, 0x09);
|
|
techpoint_write_reg(client, 0x1d, 0x38);
|
|
|
|
techpoint_write_reg(client, 0x20, 0x40);
|
|
techpoint_write_reg(client, 0x21, 0x84);
|
|
techpoint_write_reg(client, 0x22, 0x36);
|
|
techpoint_write_reg(client, 0x23, 0x3c);
|
|
|
|
techpoint_write_reg(client, 0x2b, 0x70);
|
|
techpoint_write_reg(client, 0x2c, 0x2a);
|
|
techpoint_write_reg(client, 0x2d, 0x68);
|
|
techpoint_write_reg(client, 0x2e, 0x57);
|
|
|
|
techpoint_write_reg(client, 0x30, 0x62);
|
|
techpoint_write_reg(client, 0x31, 0xbb);
|
|
techpoint_write_reg(client, 0x32, 0x96);
|
|
techpoint_write_reg(client, 0x33, 0xc0);
|
|
|
|
techpoint_write_reg(client, 0x35, 0x65);
|
|
techpoint_write_reg(client, 0x38, 0x00);
|
|
techpoint_write_reg(client, 0x39, 0x04);
|
|
|
|
techpoint_write_reg(client, 0x40, 0x08);
|
|
techpoint_write_reg(client, 0x23, 0x02);
|
|
techpoint_write_reg(client, 0x13, 0x24);
|
|
techpoint_write_reg(client, 0x14, 0x57);
|
|
techpoint_write_reg(client, 0x15, 0x0e);
|
|
|
|
techpoint_write_reg(client, 0x25, 0x02);
|
|
techpoint_write_reg(client, 0x26, 0x00);
|
|
techpoint_write_reg(client, 0x27, 0x03);
|
|
|
|
techpoint_write_reg(client, 0x10, 0x88);
|
|
techpoint_write_reg(client, 0x10, 0x08);
|
|
techpoint_write_reg(client, 0x23, 0x00);
|
|
techpoint_write_reg(client, 0x40, 0x00);
|
|
break;
|
|
}
|
|
|
|
#if TECHPOINT_TEST_PATTERN
|
|
techpoint_write_reg(client, 0x2a, 0x3c);
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
int tp9950_get_channel_reso(struct i2c_client *client, int ch)
|
|
{
|
|
u8 detect_fmt = 0xff;
|
|
u8 reso = 0xff;
|
|
|
|
techpoint_write_reg(client, 0x40, ch);
|
|
techpoint_read_reg(client, 0x03, &detect_fmt);
|
|
reso = detect_fmt & 0x7;
|
|
|
|
switch (reso) {
|
|
case TP9950_CVSTD_720P_25:
|
|
#if TP9950_DEF_720P
|
|
default:
|
|
#endif
|
|
dev_err(&client->dev, "detect channel %d 720P_25\n", ch);
|
|
return TECHPOINT_S_RESO_720P_25;
|
|
case TP9950_CVSTD_1080P_25:
|
|
#if TP9950_DEF_1080P
|
|
default:
|
|
#endif
|
|
dev_err(&client->dev, "detect channel %d 1080P_25\n", ch);
|
|
return TECHPOINT_S_RESO_1080P_25;
|
|
case TP9950_CVSTD_PAL:
|
|
#if TP9950_DEF_PAL
|
|
default:
|
|
#endif
|
|
dev_err(&client->dev, "detect channel %d PAL\n", ch);
|
|
return TECHPOINT_S_RESO_PAL;
|
|
case TP9950_CVSTD_NTSC:
|
|
#if TP9950_DEF_NTSC
|
|
default:
|
|
#endif
|
|
dev_err(&client->dev, "detect channel %d NTSC\n", ch);
|
|
return TECHPOINT_S_RESO_NTSC;
|
|
}
|
|
|
|
return reso;
|
|
}
|
|
|
|
int tp9950_set_quick_stream(struct i2c_client *client, u32 stream)
|
|
{
|
|
return 0;
|
|
}
|