diff options
Diffstat (limited to 'drivers/media/video/tvmixer.c')
-rw-r--r-- | drivers/media/video/tvmixer.c | 367 |
1 files changed, 367 insertions, 0 deletions
diff --git a/drivers/media/video/tvmixer.c b/drivers/media/video/tvmixer.c new file mode 100644 index 000000000000..eafd7061b310 --- /dev/null +++ b/drivers/media/video/tvmixer.c | |||
@@ -0,0 +1,367 @@ | |||
1 | #include <linux/module.h> | ||
2 | #include <linux/moduleparam.h> | ||
3 | #include <linux/kernel.h> | ||
4 | #include <linux/sched.h> | ||
5 | #include <linux/string.h> | ||
6 | #include <linux/timer.h> | ||
7 | #include <linux/delay.h> | ||
8 | #include <linux/errno.h> | ||
9 | #include <linux/slab.h> | ||
10 | #include <linux/i2c.h> | ||
11 | #include <linux/videodev.h> | ||
12 | #include <linux/init.h> | ||
13 | #include <linux/kdev_t.h> | ||
14 | #include <linux/sound.h> | ||
15 | #include <linux/soundcard.h> | ||
16 | |||
17 | #include <asm/semaphore.h> | ||
18 | #include <asm/uaccess.h> | ||
19 | |||
20 | |||
21 | #define DEV_MAX 4 | ||
22 | |||
23 | static int devnr = -1; | ||
24 | module_param(devnr, int, 0644); | ||
25 | |||
26 | MODULE_AUTHOR("Gerd Knorr"); | ||
27 | MODULE_LICENSE("GPL"); | ||
28 | |||
29 | /* ----------------------------------------------------------------------- */ | ||
30 | |||
31 | struct TVMIXER { | ||
32 | struct i2c_client *dev; | ||
33 | int minor; | ||
34 | int count; | ||
35 | }; | ||
36 | |||
37 | static struct TVMIXER devices[DEV_MAX]; | ||
38 | |||
39 | static int tvmixer_adapters(struct i2c_adapter *adap); | ||
40 | static int tvmixer_clients(struct i2c_client *client); | ||
41 | |||
42 | /* ----------------------------------------------------------------------- */ | ||
43 | |||
44 | static int mix_to_v4l(int i) | ||
45 | { | ||
46 | int r; | ||
47 | |||
48 | r = ((i & 0xff) * 65536 + 50) / 100; | ||
49 | if (r > 65535) r = 65535; | ||
50 | if (r < 0) r = 0; | ||
51 | return r; | ||
52 | } | ||
53 | |||
54 | static int v4l_to_mix(int i) | ||
55 | { | ||
56 | int r; | ||
57 | |||
58 | r = (i * 100 + 32768) / 65536; | ||
59 | if (r > 100) r = 100; | ||
60 | if (r < 0) r = 0; | ||
61 | return r | (r << 8); | ||
62 | } | ||
63 | |||
64 | static int v4l_to_mix2(int l, int r) | ||
65 | { | ||
66 | r = (r * 100 + 32768) / 65536; | ||
67 | if (r > 100) r = 100; | ||
68 | if (r < 0) r = 0; | ||
69 | l = (l * 100 + 32768) / 65536; | ||
70 | if (l > 100) l = 100; | ||
71 | if (l < 0) l = 0; | ||
72 | return (r << 8) | l; | ||
73 | } | ||
74 | |||
75 | static int tvmixer_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg) | ||
76 | { | ||
77 | struct video_audio va; | ||
78 | int left,right,ret,val = 0; | ||
79 | struct TVMIXER *mix = file->private_data; | ||
80 | struct i2c_client *client = mix->dev; | ||
81 | void __user *argp = (void __user *)arg; | ||
82 | int __user *p = argp; | ||
83 | |||
84 | if (NULL == client) | ||
85 | return -ENODEV; | ||
86 | |||
87 | if (cmd == SOUND_MIXER_INFO) { | ||
88 | mixer_info info; | ||
89 | strlcpy(info.id, "tv card", sizeof(info.id)); | ||
90 | strlcpy(info.name, i2c_clientname(client), sizeof(info.name)); | ||
91 | info.modify_counter = 42 /* FIXME */; | ||
92 | if (copy_to_user(argp, &info, sizeof(info))) | ||
93 | return -EFAULT; | ||
94 | return 0; | ||
95 | } | ||
96 | if (cmd == SOUND_OLD_MIXER_INFO) { | ||
97 | _old_mixer_info info; | ||
98 | strlcpy(info.id, "tv card", sizeof(info.id)); | ||
99 | strlcpy(info.name, i2c_clientname(client), sizeof(info.name)); | ||
100 | if (copy_to_user(argp, &info, sizeof(info))) | ||
101 | return -EFAULT; | ||
102 | return 0; | ||
103 | } | ||
104 | if (cmd == OSS_GETVERSION) | ||
105 | return put_user(SOUND_VERSION, p); | ||
106 | |||
107 | if (_SIOC_DIR(cmd) & _SIOC_WRITE) | ||
108 | if (get_user(val, p)) | ||
109 | return -EFAULT; | ||
110 | |||
111 | /* read state */ | ||
112 | memset(&va,0,sizeof(va)); | ||
113 | client->driver->command(client,VIDIOCGAUDIO,&va); | ||
114 | |||
115 | switch (cmd) { | ||
116 | case MIXER_READ(SOUND_MIXER_RECMASK): | ||
117 | case MIXER_READ(SOUND_MIXER_CAPS): | ||
118 | case MIXER_READ(SOUND_MIXER_RECSRC): | ||
119 | case MIXER_WRITE(SOUND_MIXER_RECSRC): | ||
120 | ret = 0; | ||
121 | break; | ||
122 | |||
123 | case MIXER_READ(SOUND_MIXER_STEREODEVS): | ||
124 | ret = SOUND_MASK_VOLUME; | ||
125 | break; | ||
126 | case MIXER_READ(SOUND_MIXER_DEVMASK): | ||
127 | ret = SOUND_MASK_VOLUME; | ||
128 | if (va.flags & VIDEO_AUDIO_BASS) | ||
129 | ret |= SOUND_MASK_BASS; | ||
130 | if (va.flags & VIDEO_AUDIO_TREBLE) | ||
131 | ret |= SOUND_MASK_TREBLE; | ||
132 | break; | ||
133 | |||
134 | case MIXER_WRITE(SOUND_MIXER_VOLUME): | ||
135 | left = mix_to_v4l(val); | ||
136 | right = mix_to_v4l(val >> 8); | ||
137 | va.volume = max(left,right); | ||
138 | va.balance = (32768*min(left,right)) / (va.volume ? va.volume : 1); | ||
139 | va.balance = (left<right) ? (65535-va.balance) : va.balance; | ||
140 | if (va.volume) | ||
141 | va.flags &= ~VIDEO_AUDIO_MUTE; | ||
142 | client->driver->command(client,VIDIOCSAUDIO,&va); | ||
143 | client->driver->command(client,VIDIOCGAUDIO,&va); | ||
144 | /* fall throuth */ | ||
145 | case MIXER_READ(SOUND_MIXER_VOLUME): | ||
146 | left = (min(65536 - va.balance,32768) * | ||
147 | va.volume) / 32768; | ||
148 | right = (min(va.balance,(u16)32768) * | ||
149 | va.volume) / 32768; | ||
150 | ret = v4l_to_mix2(left,right); | ||
151 | break; | ||
152 | |||
153 | case MIXER_WRITE(SOUND_MIXER_BASS): | ||
154 | va.bass = mix_to_v4l(val); | ||
155 | client->driver->command(client,VIDIOCSAUDIO,&va); | ||
156 | client->driver->command(client,VIDIOCGAUDIO,&va); | ||
157 | /* fall throuth */ | ||
158 | case MIXER_READ(SOUND_MIXER_BASS): | ||
159 | ret = v4l_to_mix(va.bass); | ||
160 | break; | ||
161 | |||
162 | case MIXER_WRITE(SOUND_MIXER_TREBLE): | ||
163 | va.treble = mix_to_v4l(val); | ||
164 | client->driver->command(client,VIDIOCSAUDIO,&va); | ||
165 | client->driver->command(client,VIDIOCGAUDIO,&va); | ||
166 | /* fall throuth */ | ||
167 | case MIXER_READ(SOUND_MIXER_TREBLE): | ||
168 | ret = v4l_to_mix(va.treble); | ||
169 | break; | ||
170 | |||
171 | default: | ||
172 | return -EINVAL; | ||
173 | } | ||
174 | if (put_user(ret, p)) | ||
175 | return -EFAULT; | ||
176 | return 0; | ||
177 | } | ||
178 | |||
179 | static int tvmixer_open(struct inode *inode, struct file *file) | ||
180 | { | ||
181 | int i, minor = iminor(inode); | ||
182 | struct TVMIXER *mix = NULL; | ||
183 | struct i2c_client *client = NULL; | ||
184 | |||
185 | for (i = 0; i < DEV_MAX; i++) { | ||
186 | if (devices[i].minor == minor) { | ||
187 | mix = devices+i; | ||
188 | client = mix->dev; | ||
189 | break; | ||
190 | } | ||
191 | } | ||
192 | |||
193 | if (NULL == client) | ||
194 | return -ENODEV; | ||
195 | |||
196 | /* lock bttv in memory while the mixer is in use */ | ||
197 | file->private_data = mix; | ||
198 | #ifndef I2C_PEC | ||
199 | if (client->adapter->inc_use) | ||
200 | client->adapter->inc_use(client->adapter); | ||
201 | #endif | ||
202 | if (client->adapter->owner) | ||
203 | try_module_get(client->adapter->owner); | ||
204 | return 0; | ||
205 | } | ||
206 | |||
207 | static int tvmixer_release(struct inode *inode, struct file *file) | ||
208 | { | ||
209 | struct TVMIXER *mix = file->private_data; | ||
210 | struct i2c_client *client; | ||
211 | |||
212 | client = mix->dev; | ||
213 | if (NULL == client) { | ||
214 | return -ENODEV; | ||
215 | } | ||
216 | |||
217 | #ifndef I2C_PEC | ||
218 | if (client->adapter->dec_use) | ||
219 | client->adapter->dec_use(client->adapter); | ||
220 | #endif | ||
221 | if (client->adapter->owner) | ||
222 | module_put(client->adapter->owner); | ||
223 | return 0; | ||
224 | } | ||
225 | |||
226 | static struct i2c_driver driver = { | ||
227 | #ifdef I2C_PEC | ||
228 | .owner = THIS_MODULE, | ||
229 | #endif | ||
230 | .name = "tv card mixer driver", | ||
231 | .id = I2C_DRIVERID_TVMIXER, | ||
232 | #ifdef I2C_DF_DUMMY | ||
233 | .flags = I2C_DF_DUMMY, | ||
234 | #else | ||
235 | .flags = I2C_DF_NOTIFY, | ||
236 | .detach_adapter = tvmixer_adapters, | ||
237 | #endif | ||
238 | .attach_adapter = tvmixer_adapters, | ||
239 | .detach_client = tvmixer_clients, | ||
240 | }; | ||
241 | |||
242 | static struct file_operations tvmixer_fops = { | ||
243 | .owner = THIS_MODULE, | ||
244 | .llseek = no_llseek, | ||
245 | .ioctl = tvmixer_ioctl, | ||
246 | .open = tvmixer_open, | ||
247 | .release = tvmixer_release, | ||
248 | }; | ||
249 | |||
250 | /* ----------------------------------------------------------------------- */ | ||
251 | |||
252 | static int tvmixer_adapters(struct i2c_adapter *adap) | ||
253 | { | ||
254 | struct list_head *item; | ||
255 | struct i2c_client *client; | ||
256 | |||
257 | list_for_each(item,&adap->clients) { | ||
258 | client = list_entry(item, struct i2c_client, list); | ||
259 | tvmixer_clients(client); | ||
260 | } | ||
261 | return 0; | ||
262 | } | ||
263 | |||
264 | static int tvmixer_clients(struct i2c_client *client) | ||
265 | { | ||
266 | struct video_audio va; | ||
267 | int i,minor; | ||
268 | |||
269 | #ifdef I2C_CLASS_TV_ANALOG | ||
270 | if (!(client->adapter->class & I2C_CLASS_TV_ANALOG)) | ||
271 | return -1; | ||
272 | #else | ||
273 | /* TV card ??? */ | ||
274 | switch (client->adapter->id) { | ||
275 | case I2C_ALGO_BIT | I2C_HW_SMBUS_VOODOO3: | ||
276 | case I2C_ALGO_BIT | I2C_HW_B_BT848: | ||
277 | case I2C_ALGO_BIT | I2C_HW_B_RIVA: | ||
278 | /* ok, have a look ... */ | ||
279 | break; | ||
280 | default: | ||
281 | /* ignore that one */ | ||
282 | return -1; | ||
283 | } | ||
284 | #endif | ||
285 | |||
286 | /* unregister ?? */ | ||
287 | for (i = 0; i < DEV_MAX; i++) { | ||
288 | if (devices[i].dev == client) { | ||
289 | /* unregister */ | ||
290 | unregister_sound_mixer(devices[i].minor); | ||
291 | devices[i].dev = NULL; | ||
292 | devices[i].minor = -1; | ||
293 | printk("tvmixer: %s unregistered (#1)\n", | ||
294 | i2c_clientname(client)); | ||
295 | return 0; | ||
296 | } | ||
297 | } | ||
298 | |||
299 | /* look for a free slot */ | ||
300 | for (i = 0; i < DEV_MAX; i++) | ||
301 | if (NULL == devices[i].dev) | ||
302 | break; | ||
303 | if (i == DEV_MAX) { | ||
304 | printk(KERN_WARNING "tvmixer: DEV_MAX too small\n"); | ||
305 | return -1; | ||
306 | } | ||
307 | |||
308 | /* audio chip with mixer ??? */ | ||
309 | if (NULL == client->driver->command) | ||
310 | return -1; | ||
311 | memset(&va,0,sizeof(va)); | ||
312 | if (0 != client->driver->command(client,VIDIOCGAUDIO,&va)) | ||
313 | return -1; | ||
314 | if (0 == (va.flags & VIDEO_AUDIO_VOLUME)) | ||
315 | return -1; | ||
316 | |||
317 | /* everything is fine, register */ | ||
318 | if ((minor = register_sound_mixer(&tvmixer_fops,devnr)) < 0) { | ||
319 | printk(KERN_ERR "tvmixer: cannot allocate mixer device\n"); | ||
320 | return -1; | ||
321 | } | ||
322 | |||
323 | devices[i].minor = minor; | ||
324 | devices[i].count = 0; | ||
325 | devices[i].dev = client; | ||
326 | printk("tvmixer: %s (%s) registered with minor %d\n", | ||
327 | client->name,client->adapter->name,minor); | ||
328 | |||
329 | return 0; | ||
330 | } | ||
331 | |||
332 | /* ----------------------------------------------------------------------- */ | ||
333 | |||
334 | static int __init tvmixer_init_module(void) | ||
335 | { | ||
336 | int i; | ||
337 | |||
338 | for (i = 0; i < DEV_MAX; i++) | ||
339 | devices[i].minor = -1; | ||
340 | |||
341 | return i2c_add_driver(&driver); | ||
342 | } | ||
343 | |||
344 | static void __exit tvmixer_cleanup_module(void) | ||
345 | { | ||
346 | int i; | ||
347 | |||
348 | i2c_del_driver(&driver); | ||
349 | for (i = 0; i < DEV_MAX; i++) { | ||
350 | if (devices[i].minor != -1) { | ||
351 | unregister_sound_mixer(devices[i].minor); | ||
352 | printk("tvmixer: %s unregistered (#2)\n", | ||
353 | i2c_clientname(devices[i].dev)); | ||
354 | } | ||
355 | } | ||
356 | } | ||
357 | |||
358 | module_init(tvmixer_init_module); | ||
359 | module_exit(tvmixer_cleanup_module); | ||
360 | |||
361 | /* | ||
362 | * Overrides for Emacs so that we follow Linus's tabbing style. | ||
363 | * --------------------------------------------------------------------------- | ||
364 | * Local variables: | ||
365 | * c-basic-offset: 8 | ||
366 | * End: | ||
367 | */ | ||