]> git.proxmox.com Git - mirror_ubuntu-jammy-kernel.git/blame - drivers/media/video/saa7134/saa7134-empress.c
V4L/DVB (3318b): sem2mutex: drivers/media/, #2
[mirror_ubuntu-jammy-kernel.git] / drivers / media / video / saa7134 / saa7134-empress.c
CommitLineData
1da177e4 1/*
1da177e4
LT
2 *
3 * (c) 2004 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
18 */
19
20#include <linux/init.h>
21#include <linux/list.h>
22#include <linux/module.h>
23#include <linux/moduleparam.h>
24#include <linux/kernel.h>
25#include <linux/slab.h>
26#include <linux/delay.h>
27
28#include "saa7134-reg.h"
29#include "saa7134.h"
30
31#include <media/saa6752hs.h>
5e453dc7 32#include <media/v4l2-common.h>
1da177e4
LT
33
34/* ------------------------------------------------------------------ */
35
36MODULE_AUTHOR("Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]");
37MODULE_LICENSE("GPL");
38
39static unsigned int empress_nr[] = {[0 ... (SAA7134_MAXBOARDS - 1)] = UNSET };
674434c6 40
1da177e4
LT
41module_param_array(empress_nr, int, NULL, 0444);
42MODULE_PARM_DESC(empress_nr,"ts device number");
43
44static unsigned int debug = 0;
45module_param(debug, int, 0644);
46MODULE_PARM_DESC(debug,"enable debug messages");
47
48#define dprintk(fmt, arg...) if (debug) \
49 printk(KERN_DEBUG "%s/empress: " fmt, dev->name , ## arg)
50
51/* ------------------------------------------------------------------ */
52
53static void ts_reset_encoder(struct saa7134_dev* dev)
54{
55 if (!dev->empress_started)
56 return;
57
58 saa_writeb(SAA7134_SPECIAL_MODE, 0x00);
59 msleep(10);
4ac97914 60 saa_writeb(SAA7134_SPECIAL_MODE, 0x01);
1da177e4
LT
61 msleep(100);
62 dev->empress_started = 0;
63}
64
65static int ts_init_encoder(struct saa7134_dev* dev)
66{
67 ts_reset_encoder(dev);
68 saa7134_i2c_call_clients(dev, VIDIOC_S_MPEGCOMP, NULL);
69 dev->empress_started = 1;
4ac97914 70 return 0;
1da177e4
LT
71}
72
73/* ------------------------------------------------------------------ */
74
75static int ts_open(struct inode *inode, struct file *file)
76{
77 int minor = iminor(inode);
78 struct saa7134_dev *h,*dev = NULL;
79 struct list_head *list;
80 int err;
81
82 list_for_each(list,&saa7134_devlist) {
83 h = list_entry(list, struct saa7134_dev, devlist);
84 if (h->empress_dev && h->empress_dev->minor == minor)
85 dev = h;
86 }
87 if (NULL == dev)
88 return -ENODEV;
89
90 dprintk("open minor=%d\n",minor);
91 err = -EBUSY;
3593cab5 92 if (!mutex_trylock(&dev->empress_tsq.lock))
1da177e4
LT
93 goto done;
94 if (dev->empress_users)
95 goto done_up;
96
97 dev->empress_users++;
98 file->private_data = dev;
99 err = 0;
100
101done_up:
3593cab5 102 mutex_unlock(&dev->empress_tsq.lock);
1da177e4
LT
103done:
104 return err;
105}
106
107static int ts_release(struct inode *inode, struct file *file)
108{
109 struct saa7134_dev *dev = file->private_data;
110
111 if (dev->empress_tsq.streaming)
112 videobuf_streamoff(&dev->empress_tsq);
3593cab5 113 mutex_lock(&dev->empress_tsq.lock);
1da177e4
LT
114 if (dev->empress_tsq.reading)
115 videobuf_read_stop(&dev->empress_tsq);
116 videobuf_mmap_free(&dev->empress_tsq);
117 dev->empress_users--;
118
119 /* stop the encoder */
120 ts_reset_encoder(dev);
121
3593cab5 122 mutex_unlock(&dev->empress_tsq.lock);
1da177e4
LT
123 return 0;
124}
125
126static ssize_t
127ts_read(struct file *file, char __user *data, size_t count, loff_t *ppos)
128{
129 struct saa7134_dev *dev = file->private_data;
130
131 if (!dev->empress_started)
132 ts_init_encoder(dev);
133
134 return videobuf_read_stream(&dev->empress_tsq,
135 data, count, ppos, 0,
136 file->f_flags & O_NONBLOCK);
137}
138
139static unsigned int
140ts_poll(struct file *file, struct poll_table_struct *wait)
141{
142 struct saa7134_dev *dev = file->private_data;
143
144 return videobuf_poll_stream(file, &dev->empress_tsq, wait);
145}
146
147
148static int
149ts_mmap(struct file *file, struct vm_area_struct * vma)
150{
151 struct saa7134_dev *dev = file->private_data;
152
153 return videobuf_mmap_mapper(&dev->empress_tsq, vma);
154}
155
156/*
157 * This function is _not_ called directly, but from
158 * video_generic_ioctl (and maybe others). userspace
159 * copying is done already, arg is a kernel pointer.
160 */
161static int ts_do_ioctl(struct inode *inode, struct file *file,
162 unsigned int cmd, void *arg)
163{
164 struct saa7134_dev *dev = file->private_data;
165
166 if (debug > 1)
5e453dc7 167 v4l_print_ioctl(dev->name,cmd);
1da177e4
LT
168 switch (cmd) {
169 case VIDIOC_QUERYCAP:
170 {
171 struct v4l2_capability *cap = arg;
172
173 memset(cap,0,sizeof(*cap));
4ac97914 174 strcpy(cap->driver, "saa7134");
1da177e4
LT
175 strlcpy(cap->card, saa7134_boards[dev->board].name,
176 sizeof(cap->card));
177 sprintf(cap->bus_info,"PCI:%s",pci_name(dev->pci));
178 cap->version = SAA7134_VERSION_CODE;
179 cap->capabilities =
180 V4L2_CAP_VIDEO_CAPTURE |
181 V4L2_CAP_READWRITE |
182 V4L2_CAP_STREAMING;
183 return 0;
184 }
185
186 /* --- input switching --------------------------------------- */
187 case VIDIOC_ENUMINPUT:
188 {
189 struct v4l2_input *i = arg;
190
191 if (i->index != 0)
192 return -EINVAL;
193 i->type = V4L2_INPUT_TYPE_CAMERA;
194 strcpy(i->name,"CCIR656");
195 return 0;
196 }
197 case VIDIOC_G_INPUT:
198 {
199 int *i = arg;
200 *i = 0;
201 return 0;
202 }
203 case VIDIOC_S_INPUT:
204 {
205 int *i = arg;
206
207 if (*i != 0)
208 return -EINVAL;
209 return 0;
210 }
211 /* --- capture ioctls ---------------------------------------- */
212
213 case VIDIOC_ENUM_FMT:
214 {
215 struct v4l2_fmtdesc *f = arg;
216 int index;
217
218 index = f->index;
219 if (index != 0)
220 return -EINVAL;
221
222 memset(f,0,sizeof(*f));
223 f->index = index;
224 strlcpy(f->description, "MPEG TS", sizeof(f->description));
225 f->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
226 f->pixelformat = V4L2_PIX_FMT_MPEG;
227 return 0;
228 }
229
230 case VIDIOC_G_FMT:
231 {
232 struct v4l2_format *f = arg;
233
234 memset(f,0,sizeof(*f));
235 f->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
236
0a4c9c93 237 saa7134_i2c_call_clients(dev, cmd, arg);
1da177e4
LT
238 f->fmt.pix.pixelformat = V4L2_PIX_FMT_MPEG;
239 f->fmt.pix.sizeimage = TS_PACKET_SIZE * dev->ts.nr_packets;
240 return 0;
241 }
242
243 case VIDIOC_S_FMT:
244 {
245 struct v4l2_format *f = arg;
246
247 if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
248 return -EINVAL;
249
0a4c9c93 250 saa7134_i2c_call_clients(dev, cmd, arg);
1da177e4
LT
251 f->fmt.pix.pixelformat = V4L2_PIX_FMT_MPEG;
252 f->fmt.pix.sizeimage = TS_PACKET_SIZE* dev->ts.nr_packets;
253 return 0;
254 }
255
256 case VIDIOC_REQBUFS:
257 return videobuf_reqbufs(&dev->empress_tsq,arg);
258
259 case VIDIOC_QUERYBUF:
260 return videobuf_querybuf(&dev->empress_tsq,arg);
261
262 case VIDIOC_QBUF:
263 return videobuf_qbuf(&dev->empress_tsq,arg);
264
265 case VIDIOC_DQBUF:
266 return videobuf_dqbuf(&dev->empress_tsq,arg,
267 file->f_flags & O_NONBLOCK);
268
269 case VIDIOC_STREAMON:
270 return videobuf_streamon(&dev->empress_tsq);
271
272 case VIDIOC_STREAMOFF:
273 return videobuf_streamoff(&dev->empress_tsq);
274
275 case VIDIOC_QUERYCTRL:
276 case VIDIOC_G_CTRL:
277 case VIDIOC_S_CTRL:
278 return saa7134_common_ioctl(dev, cmd, arg);
279
280 case VIDIOC_S_MPEGCOMP:
281 saa7134_i2c_call_clients(dev, VIDIOC_S_MPEGCOMP, arg);
282 ts_init_encoder(dev);
283 return 0;
284 case VIDIOC_G_MPEGCOMP:
285 saa7134_i2c_call_clients(dev, VIDIOC_G_MPEGCOMP, arg);
286 return 0;
287
288 default:
289 return -ENOIOCTLCMD;
290 }
291 return 0;
292}
293
294static int ts_ioctl(struct inode *inode, struct file *file,
295 unsigned int cmd, unsigned long arg)
296{
297 return video_usercopy(inode, file, cmd, arg, ts_do_ioctl);
298}
299
300static struct file_operations ts_fops =
301{
302 .owner = THIS_MODULE,
303 .open = ts_open,
304 .release = ts_release,
305 .read = ts_read,
306 .poll = ts_poll,
307 .mmap = ts_mmap,
308 .ioctl = ts_ioctl,
309 .llseek = no_llseek,
310};
311
312/* ----------------------------------------------------------- */
313
314static struct video_device saa7134_empress_template =
315{
316 .name = "saa7134-empress",
317 .type = 0 /* FIXME */,
318 .type2 = 0 /* FIXME */,
319 .hardware = 0,
320 .fops = &ts_fops,
321 .minor = -1,
322};
323
324static void empress_signal_update(void* data)
325{
326 struct saa7134_dev* dev = (struct saa7134_dev*) data;
327
328 if (dev->nosignal) {
329 dprintk("no video signal\n");
330 ts_reset_encoder(dev);
331 } else {
332 dprintk("video signal acquired\n");
333 if (dev->empress_users)
334 ts_init_encoder(dev);
335 }
336}
337
338static void empress_signal_change(struct saa7134_dev *dev)
339{
340 schedule_work(&dev->empress_workqueue);
341}
342
343
344static int empress_init(struct saa7134_dev *dev)
345{
346 int err;
347
348 dprintk("%s: %s\n",dev->name,__FUNCTION__);
349 dev->empress_dev = video_device_alloc();
350 if (NULL == dev->empress_dev)
351 return -ENOMEM;
352 *(dev->empress_dev) = saa7134_empress_template;
353 dev->empress_dev->dev = &dev->pci->dev;
354 dev->empress_dev->release = video_device_release;
355 snprintf(dev->empress_dev->name, sizeof(dev->empress_dev->name),
356 "%s empress (%s)", dev->name,
357 saa7134_boards[dev->board].name);
358
359 INIT_WORK(&dev->empress_workqueue, empress_signal_update, (void*) dev);
360
361 err = video_register_device(dev->empress_dev,VFL_TYPE_GRABBER,
362 empress_nr[dev->nr]);
363 if (err < 0) {
364 printk(KERN_INFO "%s: can't register video device\n",
365 dev->name);
366 video_device_release(dev->empress_dev);
367 dev->empress_dev = NULL;
368 return err;
369 }
370 printk(KERN_INFO "%s: registered device video%d [mpeg]\n",
371 dev->name,dev->empress_dev->minor & 0x1f);
372
373 videobuf_queue_init(&dev->empress_tsq, &saa7134_ts_qops,
374 dev->pci, &dev->slock,
375 V4L2_BUF_TYPE_VIDEO_CAPTURE,
376 V4L2_FIELD_ALTERNATE,
377 sizeof(struct saa7134_buf),
378 dev);
379
380 empress_signal_update(dev);
381 return 0;
382}
383
384static int empress_fini(struct saa7134_dev *dev)
385{
386 dprintk("%s: %s\n",dev->name,__FUNCTION__);
387
388 if (NULL == dev->empress_dev)
389 return 0;
390 flush_scheduled_work();
391 video_unregister_device(dev->empress_dev);
392 dev->empress_dev = NULL;
393 return 0;
394}
395
396static struct saa7134_mpeg_ops empress_ops = {
397 .type = SAA7134_MPEG_EMPRESS,
398 .init = empress_init,
399 .fini = empress_fini,
400 .signal_change = empress_signal_change,
401};
402
403static int __init empress_register(void)
404{
405 return saa7134_ts_register(&empress_ops);
406}
407
408static void __exit empress_unregister(void)
409{
410 saa7134_ts_unregister(&empress_ops);
411}
412
413module_init(empress_register);
414module_exit(empress_unregister);
415
416/* ----------------------------------------------------------- */
417/*
418 * Local variables:
419 * c-basic-offset: 8
420 * End:
421 */