AcoSail/kernel_optimize_test
8
0
Fork 0
forked from luck/tmp_suning_uos_patched
Code Pull Requests Activity
30a2da7b7e
kernel_optimize_test/drivers/media/i2c/saa7185.c
Thomas Gleixner c942fddf87 treewide: Replace GPLv2 boilerplate/reference with SPDX - rule 157 
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>
2019-05-30 11:26:37 -07:00

354 lines
9.0 KiB
C
Raw Blame History

// 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);
View Git Blame Copy Permalink