aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/media/video/vp27smpx.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/media/video/vp27smpx.c')
-rw-r--r--drivers/media/video/vp27smpx.c211
1 files changed, 211 insertions, 0 deletions
diff --git a/drivers/media/video/vp27smpx.c b/drivers/media/video/vp27smpx.c
new file mode 100644
index 000000000000..9aa526bd2c84
--- /dev/null
+++ b/drivers/media/video/vp27smpx.c
@@ -0,0 +1,211 @@
1/*
2 * vp27smpx - driver version 0.0.1
3 *
4 * Copyright (C) 2007 Hans Verkuil <hverkuil@xs4all.nl>
5 *
6 * Special thanks to Kazz for the i2c data.
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21 */
22
23#include <linux/module.h>
24#include <linux/types.h>
25#include <linux/ioctl.h>
26#include <asm/uaccess.h>
27#include <linux/i2c.h>
28#include <linux/i2c-id.h>
29#include <linux/videodev.h>
30#include <media/v4l2-common.h>
31#include <media/v4l2-chip-ident.h>
32
33MODULE_DESCRIPTION("vp27smpx driver");
34MODULE_AUTHOR("Hans Verkuil");
35MODULE_LICENSE("GPL");
36
37static unsigned short normal_i2c[] = { 0xb6 >> 1, I2C_CLIENT_END };
38
39
40I2C_CLIENT_INSMOD;
41
42/* ----------------------------------------------------------------------- */
43
44struct vp27smpx_state {
45 int radio;
46 u32 audmode;
47};
48
49static void vp27smpx_set_audmode(struct i2c_client *client, u32 audmode)
50{
51 struct vp27smpx_state *state = i2c_get_clientdata(client);
52 u8 data[3] = { 0x00, 0x00, 0x04 };
53
54 switch (audmode) {
55 case V4L2_TUNER_MODE_MONO:
56 case V4L2_TUNER_MODE_LANG1:
57 break;
58 case V4L2_TUNER_MODE_STEREO:
59 case V4L2_TUNER_MODE_LANG1_LANG2:
60 data[1] = 0x01;
61 break;
62 case V4L2_TUNER_MODE_LANG2:
63 data[1] = 0x02;
64 break;
65 }
66
67 if (i2c_master_send(client, data, sizeof(data)) != sizeof(data)) {
68 v4l_err(client, "%s: I/O error setting audmode\n", client->name);
69 }
70 else {
71 state->audmode = audmode;
72 }
73}
74
75static int vp27smpx_command(struct i2c_client *client, unsigned int cmd,
76 void *arg)
77{
78 struct vp27smpx_state *state = i2c_get_clientdata(client);
79 struct v4l2_tuner *vt = arg;
80
81 switch (cmd) {
82 case AUDC_SET_RADIO:
83 state->radio = 1;
84 break;
85
86 case VIDIOC_S_STD:
87 state->radio = 0;
88 break;
89
90 case VIDIOC_S_TUNER:
91 if (!state->radio)
92 vp27smpx_set_audmode(client, vt->audmode);
93 break;
94
95 case VIDIOC_G_TUNER:
96 if (state->radio)
97 break;
98 vt->audmode = state->audmode;
99 vt->capability = V4L2_TUNER_CAP_STEREO |
100 V4L2_TUNER_CAP_LANG1 | V4L2_TUNER_CAP_LANG2;
101 vt->rxsubchans = V4L2_TUNER_SUB_MONO;
102 break;
103
104 case VIDIOC_G_CHIP_IDENT:
105 return v4l2_chip_ident_i2c_client(client, arg, V4L2_IDENT_VP27SMPX, 0);
106
107 case VIDIOC_LOG_STATUS:
108 v4l_info(client, "Audio Mode: %u%s\n", state->audmode,
109 state->radio ? " (Radio)" : "");
110 break;
111
112 default:
113 return -EINVAL;
114 }
115 return 0;
116}
117
118/* ----------------------------------------------------------------------- */
119
120/* i2c implementation */
121
122/*
123 * Generic i2c probe
124 * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1'
125 */
126
127static struct i2c_driver i2c_driver;
128
129static int vp27smpx_attach(struct i2c_adapter *adapter, int address, int kind)
130{
131 struct i2c_client *client;
132 struct vp27smpx_state *state;
133
134 /* Check if the adapter supports the needed features */
135 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
136 return 0;
137
138 client = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
139 if (client == 0)
140 return -ENOMEM;
141
142 client->addr = address;
143 client->adapter = adapter;
144 client->driver = &i2c_driver;
145 snprintf(client->name, sizeof(client->name) - 1, "vp27smpx");
146
147 v4l_info(client, "chip found @ 0x%x (%s)\n", address << 1, adapter->name);
148
149 state = kzalloc(sizeof(struct vp27smpx_state), GFP_KERNEL);
150 if (state == NULL) {
151 kfree(client);
152 return -ENOMEM;
153 }
154 state->audmode = V4L2_TUNER_MODE_STEREO;
155 i2c_set_clientdata(client, state);
156
157 /* initialize vp27smpx */
158 vp27smpx_set_audmode(client, state->audmode);
159 i2c_attach_client(client);
160
161 return 0;
162}
163
164static int vp27smpx_probe(struct i2c_adapter *adapter)
165{
166 if (adapter->class & I2C_CLASS_TV_ANALOG)
167 return i2c_probe(adapter, &addr_data, vp27smpx_attach);
168 return 0;
169}
170
171static int vp27smpx_detach(struct i2c_client *client)
172{
173 struct vp27smpx_state *state = i2c_get_clientdata(client);
174 int err;
175
176 err = i2c_detach_client(client);
177 if (err) {
178 return err;
179 }
180 kfree(state);
181 kfree(client);
182
183 return 0;
184}
185
186/* ----------------------------------------------------------------------- */
187
188/* i2c implementation */
189static struct i2c_driver i2c_driver = {
190 .driver = {
191 .name = "vp27smpx",
192 },
193 .id = I2C_DRIVERID_VP27SMPX,
194 .attach_adapter = vp27smpx_probe,
195 .detach_client = vp27smpx_detach,
196 .command = vp27smpx_command,
197};
198
199
200static int __init vp27smpx_init_module(void)
201{
202 return i2c_add_driver(&i2c_driver);
203}
204
205static void __exit vp27smpx_cleanup_module(void)
206{
207 i2c_del_driver(&i2c_driver);
208}
209
210module_init(vp27smpx_init_module);
211module_exit(vp27smpx_cleanup_module);