1 /*
2 * ths7303- THS7303 Video Amplifier driver
3 *
4 * Copyright (C) 2009 Texas Instruments Incorporated - http://www.ti.com/
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License as
8 * published by the Free Software Foundation version 2.
9 *
10 * This program is distributed .as is. WITHOUT ANY WARRANTY of any
11 * kind, whether express or implied; without even the implied warranty
12 * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 */
15
16 #include <linux/kernel.h>
17 #include <linux/init.h>
18 #include <linux/ctype.h>
19 #include <linux/slab.h>
20 #include <linux/i2c.h>
21 #include <linux/device.h>
22 #include <linux/delay.h>
23 #include <linux/module.h>
24 #include <linux/uaccess.h>
25 #include <linux/videodev2.h>
26
27 #include <media/v4l2-device.h>
28 #include <media/v4l2-subdev.h>
29 #include <media/v4l2-chip-ident.h>
30
31 MODULE_DESCRIPTION("TI THS7303 video amplifier driver");
32 MODULE_AUTHOR("Chaithrika U S");
33 MODULE_LICENSE("GPL");
34
35 static int debug;
36 module_param(debug, int, 0644);
37 MODULE_PARM_DESC(debug, "Debug level 0-1");
38
39 /* following function is used to set ths7303 */
ths7303_setvalue(struct v4l2_subdev * sd,v4l2_std_id std)40 static int ths7303_setvalue(struct v4l2_subdev *sd, v4l2_std_id std)
41 {
42 int err = 0;
43 u8 val;
44 struct i2c_client *client;
45
46 client = v4l2_get_subdevdata(sd);
47
48 if (std & (V4L2_STD_ALL & ~V4L2_STD_SECAM)) {
49 val = 0x02;
50 v4l2_dbg(1, debug, sd, "setting value for SDTV format\n");
51 } else {
52 val = 0x00;
53 v4l2_dbg(1, debug, sd, "disabling all channels\n");
54 }
55
56 err |= i2c_smbus_write_byte_data(client, 0x01, val);
57 err |= i2c_smbus_write_byte_data(client, 0x02, val);
58 err |= i2c_smbus_write_byte_data(client, 0x03, val);
59
60 if (err)
61 v4l2_err(sd, "write failed\n");
62
63 return err;
64 }
65
ths7303_s_std_output(struct v4l2_subdev * sd,v4l2_std_id norm)66 static int ths7303_s_std_output(struct v4l2_subdev *sd, v4l2_std_id norm)
67 {
68 return ths7303_setvalue(sd, norm);
69 }
70
ths7303_g_chip_ident(struct v4l2_subdev * sd,struct v4l2_dbg_chip_ident * chip)71 static int ths7303_g_chip_ident(struct v4l2_subdev *sd,
72 struct v4l2_dbg_chip_ident *chip)
73 {
74 struct i2c_client *client = v4l2_get_subdevdata(sd);
75
76 return v4l2_chip_ident_i2c_client(client, chip, V4L2_IDENT_THS7303, 0);
77 }
78
79 static const struct v4l2_subdev_video_ops ths7303_video_ops = {
80 .s_std_output = ths7303_s_std_output,
81 };
82
83 static const struct v4l2_subdev_core_ops ths7303_core_ops = {
84 .g_chip_ident = ths7303_g_chip_ident,
85 };
86
87 static const struct v4l2_subdev_ops ths7303_ops = {
88 .core = &ths7303_core_ops,
89 .video = &ths7303_video_ops,
90 };
91
ths7303_probe(struct i2c_client * client,const struct i2c_device_id * id)92 static int ths7303_probe(struct i2c_client *client,
93 const struct i2c_device_id *id)
94 {
95 struct v4l2_subdev *sd;
96 v4l2_std_id std_id = V4L2_STD_NTSC;
97
98 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
99 return -ENODEV;
100
101 v4l_info(client, "chip found @ 0x%x (%s)\n",
102 client->addr << 1, client->adapter->name);
103
104 sd = kzalloc(sizeof(struct v4l2_subdev), GFP_KERNEL);
105 if (sd == NULL)
106 return -ENOMEM;
107
108 v4l2_i2c_subdev_init(sd, client, &ths7303_ops);
109
110 return ths7303_setvalue(sd, std_id);
111 }
112
ths7303_remove(struct i2c_client * client)113 static int ths7303_remove(struct i2c_client *client)
114 {
115 struct v4l2_subdev *sd = i2c_get_clientdata(client);
116
117 v4l2_device_unregister_subdev(sd);
118 kfree(sd);
119
120 return 0;
121 }
122
123 static const struct i2c_device_id ths7303_id[] = {
124 {"ths7303", 0},
125 {},
126 };
127
128 MODULE_DEVICE_TABLE(i2c, ths7303_id);
129
130 static struct i2c_driver ths7303_driver = {
131 .driver = {
132 .owner = THIS_MODULE,
133 .name = "ths7303",
134 },
135 .probe = ths7303_probe,
136 .remove = ths7303_remove,
137 .id_table = ths7303_id,
138 };
139
ths7303_init(void)140 static int __init ths7303_init(void)
141 {
142 return i2c_add_driver(&ths7303_driver);
143 }
144
ths7303_exit(void)145 static void __exit ths7303_exit(void)
146 {
147 i2c_del_driver(&ths7303_driver);
148 }
149
150 module_init(ths7303_init);
151 module_exit(ths7303_exit);
152
153