mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-12-25 06:50:55 +07:00
c942fddf87
Based on 3 normalized pattern(s): this program is free software you can redistribute it and or modify it under the terms of the gnu general public license as published by the free software foundation either version 2 of the license or at your option any later version 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 this program is free software you can redistribute it and or modify it under the terms of the gnu general public license as published by the free software foundation either version 2 of the license or at your option any later version [author] [kishon] [vijay] [abraham] [i] [kishon]@[ti] [com] 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 this program is free software you can redistribute it and or modify it under the terms of the gnu general public license as published by the free software foundation either version 2 of the license or at your option any later version [author] [graeme] [gregory] [gg]@[slimlogic] [co] [uk] [author] [kishon] [vijay] [abraham] [i] [kishon]@[ti] [com] [based] [on] [twl6030]_[usb] [c] [author] [hema] [hk] [hemahk]@[ti] [com] 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 extracted by the scancode license scanner the SPDX license identifier GPL-2.0-or-later has been chosen to replace the boilerplate/reference in 1105 file(s). Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Reviewed-by: Allison Randal <allison@lohutok.net> Reviewed-by: Richard Fontana <rfontana@redhat.com> Reviewed-by: Kate Stewart <kstewart@linuxfoundation.org> Cc: linux-spdx@vger.kernel.org Link: https://lkml.kernel.org/r/20190527070033.202006027@linutronix.de Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
354 lines
9.0 KiB
C
354 lines
9.0 KiB
C
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* saa7185 - Philips SAA7185B video encoder driver version 0.0.3
|
|
*
|
|
* Copyright (C) 1998 Dave Perks <dperks@ibm.net>
|
|
*
|
|
* Slight changes for video timing and attachment output by
|
|
* Wolfgang Scherr <scherr@net4you.net>
|
|
*
|
|
* Changes by Ronald Bultje <rbultje@ronald.bitfreak.net>
|
|
* - moved over to linux>=2.4.x i2c protocol (1/1/2003)
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/types.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/ioctl.h>
|
|
#include <linux/uaccess.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/videodev2.h>
|
|
#include <media/v4l2-device.h>
|
|
|
|
MODULE_DESCRIPTION("Philips SAA7185 video encoder driver");
|
|
MODULE_AUTHOR("Dave Perks");
|
|
MODULE_LICENSE("GPL");
|
|
|
|
static int debug;
|
|
module_param(debug, int, 0);
|
|
MODULE_PARM_DESC(debug, "Debug level (0-1)");
|
|
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
struct saa7185 {
|
|
struct v4l2_subdev sd;
|
|
unsigned char reg[128];
|
|
|
|
v4l2_std_id norm;
|
|
};
|
|
|
|
static inline struct saa7185 *to_saa7185(struct v4l2_subdev *sd)
|
|
{
|
|
return container_of(sd, struct saa7185, sd);
|
|
}
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
static inline int saa7185_read(struct v4l2_subdev *sd)
|
|
{
|
|
struct i2c_client *client = v4l2_get_subdevdata(sd);
|
|
|
|
return i2c_smbus_read_byte(client);
|
|
}
|
|
|
|
static int saa7185_write(struct v4l2_subdev *sd, u8 reg, u8 value)
|
|
{
|
|
struct i2c_client *client = v4l2_get_subdevdata(sd);
|
|
struct saa7185 *encoder = to_saa7185(sd);
|
|
|
|
v4l2_dbg(1, debug, sd, "%02x set to %02x\n", reg, value);
|
|
encoder->reg[reg] = value;
|
|
return i2c_smbus_write_byte_data(client, reg, value);
|
|
}
|
|
|
|
static int saa7185_write_block(struct v4l2_subdev *sd,
|
|
const u8 *data, unsigned int len)
|
|
{
|
|
struct i2c_client *client = v4l2_get_subdevdata(sd);
|
|
struct saa7185 *encoder = to_saa7185(sd);
|
|
int ret = -1;
|
|
u8 reg;
|
|
|
|
/* the adv7175 has an autoincrement function, use it if
|
|
* the adapter understands raw I2C */
|
|
if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
|
|
/* do raw I2C, not smbus compatible */
|
|
u8 block_data[32];
|
|
int block_len;
|
|
|
|
while (len >= 2) {
|
|
block_len = 0;
|
|
block_data[block_len++] = reg = data[0];
|
|
do {
|
|
block_data[block_len++] =
|
|
encoder->reg[reg++] = data[1];
|
|
len -= 2;
|
|
data += 2;
|
|
} while (len >= 2 && data[0] == reg && block_len < 32);
|
|
ret = i2c_master_send(client, block_data, block_len);
|
|
if (ret < 0)
|
|
break;
|
|
}
|
|
} else {
|
|
/* do some slow I2C emulation kind of thing */
|
|
while (len >= 2) {
|
|
reg = *data++;
|
|
ret = saa7185_write(sd, reg, *data++);
|
|
if (ret < 0)
|
|
break;
|
|
len -= 2;
|
|
}
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
static const unsigned char init_common[] = {
|
|
0x3a, 0x0f, /* CBENB=0, V656=0, VY2C=1,
|
|
* YUV2C=1, MY2C=1, MUV2C=1 */
|
|
|
|
0x42, 0x6b, /* OVLY0=107 */
|
|
0x43, 0x00, /* OVLU0=0 white */
|
|
0x44, 0x00, /* OVLV0=0 */
|
|
0x45, 0x22, /* OVLY1=34 */
|
|
0x46, 0xac, /* OVLU1=172 yellow */
|
|
0x47, 0x0e, /* OVLV1=14 */
|
|
0x48, 0x03, /* OVLY2=3 */
|
|
0x49, 0x1d, /* OVLU2=29 cyan */
|
|
0x4a, 0xac, /* OVLV2=172 */
|
|
0x4b, 0xf0, /* OVLY3=240 */
|
|
0x4c, 0xc8, /* OVLU3=200 green */
|
|
0x4d, 0xb9, /* OVLV3=185 */
|
|
0x4e, 0xd4, /* OVLY4=212 */
|
|
0x4f, 0x38, /* OVLU4=56 magenta */
|
|
0x50, 0x47, /* OVLV4=71 */
|
|
0x51, 0xc1, /* OVLY5=193 */
|
|
0x52, 0xe3, /* OVLU5=227 red */
|
|
0x53, 0x54, /* OVLV5=84 */
|
|
0x54, 0xa3, /* OVLY6=163 */
|
|
0x55, 0x54, /* OVLU6=84 blue */
|
|
0x56, 0xf2, /* OVLV6=242 */
|
|
0x57, 0x90, /* OVLY7=144 */
|
|
0x58, 0x00, /* OVLU7=0 black */
|
|
0x59, 0x00, /* OVLV7=0 */
|
|
|
|
0x5a, 0x00, /* CHPS=0 */
|
|
0x5b, 0x76, /* GAINU=118 */
|
|
0x5c, 0xa5, /* GAINV=165 */
|
|
0x5d, 0x3c, /* BLCKL=60 */
|
|
0x5e, 0x3a, /* BLNNL=58 */
|
|
0x5f, 0x3a, /* CCRS=0, BLNVB=58 */
|
|
0x60, 0x00, /* NULL */
|
|
|
|
/* 0x61 - 0x66 set according to norm */
|
|
|
|
0x67, 0x00, /* 0 : caption 1st byte odd field */
|
|
0x68, 0x00, /* 0 : caption 2nd byte odd field */
|
|
0x69, 0x00, /* 0 : caption 1st byte even field */
|
|
0x6a, 0x00, /* 0 : caption 2nd byte even field */
|
|
|
|
0x6b, 0x91, /* MODIN=2, PCREF=0, SCCLN=17 */
|
|
0x6c, 0x20, /* SRCV1=0, TRCV2=1, ORCV1=0, PRCV1=0,
|
|
* CBLF=0, ORCV2=0, PRCV2=0 */
|
|
0x6d, 0x00, /* SRCM1=0, CCEN=0 */
|
|
|
|
0x6e, 0x0e, /* HTRIG=0x005, approx. centered, at
|
|
* least for PAL */
|
|
0x6f, 0x00, /* HTRIG upper bits */
|
|
0x70, 0x20, /* PHRES=0, SBLN=1, VTRIG=0 */
|
|
|
|
/* The following should not be needed */
|
|
|
|
0x71, 0x15, /* BMRQ=0x115 */
|
|
0x72, 0x90, /* EMRQ=0x690 */
|
|
0x73, 0x61, /* EMRQ=0x690, BMRQ=0x115 */
|
|
0x74, 0x00, /* NULL */
|
|
0x75, 0x00, /* NULL */
|
|
0x76, 0x00, /* NULL */
|
|
0x77, 0x15, /* BRCV=0x115 */
|
|
0x78, 0x90, /* ERCV=0x690 */
|
|
0x79, 0x61, /* ERCV=0x690, BRCV=0x115 */
|
|
|
|
/* Field length controls */
|
|
|
|
0x7a, 0x70, /* FLC=0 */
|
|
|
|
/* The following should not be needed if SBLN = 1 */
|
|
|
|
0x7b, 0x16, /* FAL=22 */
|
|
0x7c, 0x35, /* LAL=244 */
|
|
0x7d, 0x20, /* LAL=244, FAL=22 */
|
|
};
|
|
|
|
static const unsigned char init_pal[] = {
|
|
0x61, 0x1e, /* FISE=0, PAL=1, SCBW=1, RTCE=1,
|
|
* YGS=1, INPI=0, DOWN=0 */
|
|
0x62, 0xc8, /* DECTYP=1, BSTA=72 */
|
|
0x63, 0xcb, /* FSC0 */
|
|
0x64, 0x8a, /* FSC1 */
|
|
0x65, 0x09, /* FSC2 */
|
|
0x66, 0x2a, /* FSC3 */
|
|
};
|
|
|
|
static const unsigned char init_ntsc[] = {
|
|
0x61, 0x1d, /* FISE=1, PAL=0, SCBW=1, RTCE=1,
|
|
* YGS=1, INPI=0, DOWN=0 */
|
|
0x62, 0xe6, /* DECTYP=1, BSTA=102 */
|
|
0x63, 0x1f, /* FSC0 */
|
|
0x64, 0x7c, /* FSC1 */
|
|
0x65, 0xf0, /* FSC2 */
|
|
0x66, 0x21, /* FSC3 */
|
|
};
|
|
|
|
|
|
static int saa7185_init(struct v4l2_subdev *sd, u32 val)
|
|
{
|
|
struct saa7185 *encoder = to_saa7185(sd);
|
|
|
|
saa7185_write_block(sd, init_common, sizeof(init_common));
|
|
if (encoder->norm & V4L2_STD_NTSC)
|
|
saa7185_write_block(sd, init_ntsc, sizeof(init_ntsc));
|
|
else
|
|
saa7185_write_block(sd, init_pal, sizeof(init_pal));
|
|
return 0;
|
|
}
|
|
|
|
static int saa7185_s_std_output(struct v4l2_subdev *sd, v4l2_std_id std)
|
|
{
|
|
struct saa7185 *encoder = to_saa7185(sd);
|
|
|
|
if (std & V4L2_STD_NTSC)
|
|
saa7185_write_block(sd, init_ntsc, sizeof(init_ntsc));
|
|
else if (std & V4L2_STD_PAL)
|
|
saa7185_write_block(sd, init_pal, sizeof(init_pal));
|
|
else
|
|
return -EINVAL;
|
|
encoder->norm = std;
|
|
return 0;
|
|
}
|
|
|
|
static int saa7185_s_routing(struct v4l2_subdev *sd,
|
|
u32 input, u32 output, u32 config)
|
|
{
|
|
struct saa7185 *encoder = to_saa7185(sd);
|
|
|
|
/* RJ: input = 0: input is from SA7111
|
|
input = 1: input is from ZR36060 */
|
|
|
|
switch (input) {
|
|
case 0:
|
|
/* turn off colorbar */
|
|
saa7185_write(sd, 0x3a, 0x0f);
|
|
/* Switch RTCE to 1 */
|
|
saa7185_write(sd, 0x61, (encoder->reg[0x61] & 0xf7) | 0x08);
|
|
saa7185_write(sd, 0x6e, 0x01);
|
|
break;
|
|
|
|
case 1:
|
|
/* turn off colorbar */
|
|
saa7185_write(sd, 0x3a, 0x0f);
|
|
/* Switch RTCE to 0 */
|
|
saa7185_write(sd, 0x61, (encoder->reg[0x61] & 0xf7) | 0x00);
|
|
/* SW: a slight sync problem... */
|
|
saa7185_write(sd, 0x6e, 0x00);
|
|
break;
|
|
|
|
case 2:
|
|
/* turn on colorbar */
|
|
saa7185_write(sd, 0x3a, 0x8f);
|
|
/* Switch RTCE to 0 */
|
|
saa7185_write(sd, 0x61, (encoder->reg[0x61] & 0xf7) | 0x08);
|
|
/* SW: a slight sync problem... */
|
|
saa7185_write(sd, 0x6e, 0x01);
|
|
break;
|
|
|
|
default:
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
static const struct v4l2_subdev_core_ops saa7185_core_ops = {
|
|
.init = saa7185_init,
|
|
};
|
|
|
|
static const struct v4l2_subdev_video_ops saa7185_video_ops = {
|
|
.s_std_output = saa7185_s_std_output,
|
|
.s_routing = saa7185_s_routing,
|
|
};
|
|
|
|
static const struct v4l2_subdev_ops saa7185_ops = {
|
|
.core = &saa7185_core_ops,
|
|
.video = &saa7185_video_ops,
|
|
};
|
|
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
static int saa7185_probe(struct i2c_client *client,
|
|
const struct i2c_device_id *id)
|
|
{
|
|
int i;
|
|
struct saa7185 *encoder;
|
|
struct v4l2_subdev *sd;
|
|
|
|
/* Check if the adapter supports the needed features */
|
|
if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
|
|
return -ENODEV;
|
|
|
|
v4l_info(client, "chip found @ 0x%x (%s)\n",
|
|
client->addr << 1, client->adapter->name);
|
|
|
|
encoder = devm_kzalloc(&client->dev, sizeof(*encoder), GFP_KERNEL);
|
|
if (encoder == NULL)
|
|
return -ENOMEM;
|
|
encoder->norm = V4L2_STD_NTSC;
|
|
sd = &encoder->sd;
|
|
v4l2_i2c_subdev_init(sd, client, &saa7185_ops);
|
|
|
|
i = saa7185_write_block(sd, init_common, sizeof(init_common));
|
|
if (i >= 0)
|
|
i = saa7185_write_block(sd, init_ntsc, sizeof(init_ntsc));
|
|
if (i < 0)
|
|
v4l2_dbg(1, debug, sd, "init error %d\n", i);
|
|
else
|
|
v4l2_dbg(1, debug, sd, "revision 0x%x\n",
|
|
saa7185_read(sd) >> 5);
|
|
return 0;
|
|
}
|
|
|
|
static int saa7185_remove(struct i2c_client *client)
|
|
{
|
|
struct v4l2_subdev *sd = i2c_get_clientdata(client);
|
|
struct saa7185 *encoder = to_saa7185(sd);
|
|
|
|
v4l2_device_unregister_subdev(sd);
|
|
/* SW: output off is active */
|
|
saa7185_write(sd, 0x61, (encoder->reg[0x61]) | 0x40);
|
|
return 0;
|
|
}
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
static const struct i2c_device_id saa7185_id[] = {
|
|
{ "saa7185", 0 },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, saa7185_id);
|
|
|
|
static struct i2c_driver saa7185_driver = {
|
|
.driver = {
|
|
.name = "saa7185",
|
|
},
|
|
.probe = saa7185_probe,
|
|
.remove = saa7185_remove,
|
|
.id_table = saa7185_id,
|
|
};
|
|
|
|
module_i2c_driver(saa7185_driver);
|