media: tegra: Tegra V4L2 camera
[linux-2.6.git] / drivers / media / video / ths7303.c
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 */
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
66 static int ths7303_s_std_output(struct v4l2_subdev *sd, v4l2_std_id norm)
67 {
68         return ths7303_setvalue(sd, norm);
69 }
70
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
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
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
140 static int __init ths7303_init(void)
141 {
142         return i2c_add_driver(&ths7303_driver);
143 }
144
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