]>
Commit | Line | Data |
---|---|---|
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> | |
1da177e4 | 23 | #include <linux/kernel.h> |
405f5571 | 24 | #include <linux/smp_lock.h> |
1da177e4 LT |
25 | #include <linux/delay.h> |
26 | ||
27 | #include "saa7134-reg.h" | |
28 | #include "saa7134.h" | |
29 | ||
30 | #include <media/saa6752hs.h> | |
5e453dc7 | 31 | #include <media/v4l2-common.h> |
e281db58 | 32 | #include <media/v4l2-chip-ident.h> |
1da177e4 LT |
33 | |
34 | /* ------------------------------------------------------------------ */ | |
35 | ||
36 | MODULE_AUTHOR("Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]"); | |
37 | MODULE_LICENSE("GPL"); | |
38 | ||
39 | static unsigned int empress_nr[] = {[0 ... (SAA7134_MAXBOARDS - 1)] = UNSET }; | |
674434c6 | 40 | |
1da177e4 LT |
41 | module_param_array(empress_nr, int, NULL, 0444); |
42 | MODULE_PARM_DESC(empress_nr,"ts device number"); | |
43 | ||
ff699e6b | 44 | static unsigned int debug; |
1da177e4 LT |
45 | module_param(debug, int, 0644); |
46 | MODULE_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 | ||
53 | static 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 | ||
65 | static int ts_init_encoder(struct saa7134_dev* dev) | |
66 | { | |
f03813e4 | 67 | u32 leading_null_bytes = 0; |
86b79d66 | 68 | |
f03813e4 DB |
69 | /* If more cards start to need this, then this |
70 | should probably be added to the card definitions. */ | |
71 | switch (dev->board) { | |
72 | case SAA7134_BOARD_BEHOLD_M6: | |
73 | case SAA7134_BOARD_BEHOLD_M63: | |
74 | case SAA7134_BOARD_BEHOLD_M6_EXTRA: | |
75 | leading_null_bytes = 1; | |
76 | break; | |
77 | } | |
1da177e4 | 78 | ts_reset_encoder(dev); |
fac6986c | 79 | saa_call_all(dev, core, init, leading_null_bytes); |
1da177e4 | 80 | dev->empress_started = 1; |
4ac97914 | 81 | return 0; |
1da177e4 LT |
82 | } |
83 | ||
84 | /* ------------------------------------------------------------------ */ | |
85 | ||
bec43661 | 86 | static int ts_open(struct file *file) |
1da177e4 | 87 | { |
50462eb0 | 88 | struct video_device *vdev = video_devdata(file); |
63b0d5ad | 89 | struct saa7134_dev *dev = video_drvdata(file); |
1da177e4 LT |
90 | int err; |
91 | ||
50462eb0 | 92 | dprintk("open dev=%s\n", video_device_node_name(vdev)); |
1da177e4 | 93 | err = -EBUSY; |
64f9477f | 94 | if (!mutex_trylock(&dev->empress_tsq.vb_lock)) |
7415c760 | 95 | return err; |
1052efe0 | 96 | if (atomic_read(&dev->empress_users)) |
7415c760 | 97 | goto done; |
1da177e4 | 98 | |
b784e526 RB |
99 | /* Unmute audio */ |
100 | saa_writeb(SAA7134_AUDIO_MUTE_CTRL, | |
101 | saa_readb(SAA7134_AUDIO_MUTE_CTRL) & ~(1 << 6)); | |
102 | ||
1052efe0 | 103 | atomic_inc(&dev->empress_users); |
1da177e4 LT |
104 | file->private_data = dev; |
105 | err = 0; | |
106 | ||
1da177e4 | 107 | done: |
7415c760 | 108 | mutex_unlock(&dev->empress_tsq.vb_lock); |
1da177e4 LT |
109 | return err; |
110 | } | |
111 | ||
bec43661 | 112 | static int ts_release(struct file *file) |
1da177e4 LT |
113 | { |
114 | struct saa7134_dev *dev = file->private_data; | |
115 | ||
053fcb60 | 116 | videobuf_stop(&dev->empress_tsq); |
1da177e4 | 117 | videobuf_mmap_free(&dev->empress_tsq); |
1da177e4 LT |
118 | |
119 | /* stop the encoder */ | |
120 | ts_reset_encoder(dev); | |
121 | ||
b784e526 RB |
122 | /* Mute audio */ |
123 | saa_writeb(SAA7134_AUDIO_MUTE_CTRL, | |
124 | saa_readb(SAA7134_AUDIO_MUTE_CTRL) | (1 << 6)); | |
125 | ||
1052efe0 | 126 | atomic_dec(&dev->empress_users); |
a1789873 | 127 | |
1da177e4 LT |
128 | return 0; |
129 | } | |
130 | ||
131 | static ssize_t | |
132 | ts_read(struct file *file, char __user *data, size_t count, loff_t *ppos) | |
133 | { | |
134 | struct saa7134_dev *dev = file->private_data; | |
135 | ||
136 | if (!dev->empress_started) | |
137 | ts_init_encoder(dev); | |
138 | ||
139 | return videobuf_read_stream(&dev->empress_tsq, | |
140 | data, count, ppos, 0, | |
141 | file->f_flags & O_NONBLOCK); | |
142 | } | |
143 | ||
144 | static unsigned int | |
145 | ts_poll(struct file *file, struct poll_table_struct *wait) | |
146 | { | |
147 | struct saa7134_dev *dev = file->private_data; | |
148 | ||
149 | return videobuf_poll_stream(file, &dev->empress_tsq, wait); | |
150 | } | |
151 | ||
152 | ||
153 | static int | |
154 | ts_mmap(struct file *file, struct vm_area_struct * vma) | |
155 | { | |
156 | struct saa7134_dev *dev = file->private_data; | |
157 | ||
158 | return videobuf_mmap_mapper(&dev->empress_tsq, vma); | |
159 | } | |
160 | ||
161 | /* | |
162 | * This function is _not_ called directly, but from | |
163 | * video_generic_ioctl (and maybe others). userspace | |
164 | * copying is done already, arg is a kernel pointer. | |
165 | */ | |
2c10e8a8 MCC |
166 | |
167 | static int empress_querycap(struct file *file, void *priv, | |
168 | struct v4l2_capability *cap) | |
1da177e4 | 169 | { |
388748e6 | 170 | struct saa7134_dev *dev = file->private_data; |
2c10e8a8 MCC |
171 | |
172 | strcpy(cap->driver, "saa7134"); | |
173 | strlcpy(cap->card, saa7134_boards[dev->board].name, | |
174 | sizeof(cap->card)); | |
175 | sprintf(cap->bus_info, "PCI:%s", pci_name(dev->pci)); | |
176 | cap->version = SAA7134_VERSION_CODE; | |
177 | cap->capabilities = | |
178 | V4L2_CAP_VIDEO_CAPTURE | | |
179 | V4L2_CAP_READWRITE | | |
180 | V4L2_CAP_STREAMING; | |
181 | return 0; | |
182 | } | |
1da177e4 | 183 | |
2c10e8a8 MCC |
184 | static int empress_enum_input(struct file *file, void *priv, |
185 | struct v4l2_input *i) | |
186 | { | |
187 | if (i->index != 0) | |
188 | return -EINVAL; | |
1da177e4 | 189 | |
2c10e8a8 MCC |
190 | i->type = V4L2_INPUT_TYPE_CAMERA; |
191 | strcpy(i->name, "CCIR656"); | |
1da177e4 | 192 | |
2c10e8a8 MCC |
193 | return 0; |
194 | } | |
1da177e4 | 195 | |
2c10e8a8 MCC |
196 | static int empress_g_input(struct file *file, void *priv, unsigned int *i) |
197 | { | |
198 | *i = 0; | |
199 | return 0; | |
200 | } | |
1da177e4 | 201 | |
2c10e8a8 MCC |
202 | static int empress_s_input(struct file *file, void *priv, unsigned int i) |
203 | { | |
204 | if (i != 0) | |
205 | return -EINVAL; | |
1da177e4 | 206 | |
2c10e8a8 MCC |
207 | return 0; |
208 | } | |
1da177e4 | 209 | |
78b526a4 | 210 | static int empress_enum_fmt_vid_cap(struct file *file, void *priv, |
2c10e8a8 MCC |
211 | struct v4l2_fmtdesc *f) |
212 | { | |
213 | if (f->index != 0) | |
214 | return -EINVAL; | |
1da177e4 | 215 | |
2c10e8a8 MCC |
216 | strlcpy(f->description, "MPEG TS", sizeof(f->description)); |
217 | f->pixelformat = V4L2_PIX_FMT_MPEG; | |
1da177e4 | 218 | |
2c10e8a8 MCC |
219 | return 0; |
220 | } | |
1da177e4 | 221 | |
78b526a4 | 222 | static int empress_g_fmt_vid_cap(struct file *file, void *priv, |
2c10e8a8 MCC |
223 | struct v4l2_format *f) |
224 | { | |
a14fe960 | 225 | struct saa7134_dev *dev = file->private_data; |
1da177e4 | 226 | |
fac6986c | 227 | saa_call_all(dev, video, g_fmt, f); |
1da177e4 | 228 | |
2c10e8a8 MCC |
229 | f->fmt.pix.pixelformat = V4L2_PIX_FMT_MPEG; |
230 | f->fmt.pix.sizeimage = TS_PACKET_SIZE * dev->ts.nr_packets; | |
1da177e4 | 231 | |
2c10e8a8 MCC |
232 | return 0; |
233 | } | |
1da177e4 | 234 | |
78b526a4 | 235 | static int empress_s_fmt_vid_cap(struct file *file, void *priv, |
2c10e8a8 MCC |
236 | struct v4l2_format *f) |
237 | { | |
a14fe960 | 238 | struct saa7134_dev *dev = file->private_data; |
1da177e4 | 239 | |
fac6986c | 240 | saa_call_all(dev, video, s_fmt, f); |
1da177e4 | 241 | |
2c10e8a8 MCC |
242 | f->fmt.pix.pixelformat = V4L2_PIX_FMT_MPEG; |
243 | f->fmt.pix.sizeimage = TS_PACKET_SIZE * dev->ts.nr_packets; | |
1da177e4 | 244 | |
2c10e8a8 MCC |
245 | return 0; |
246 | } | |
247 | ||
6b6b7543 DB |
248 | static int empress_try_fmt_vid_cap(struct file *file, void *priv, |
249 | struct v4l2_format *f) | |
250 | { | |
251 | struct saa7134_dev *dev = file->private_data; | |
252 | ||
253 | f->fmt.pix.pixelformat = V4L2_PIX_FMT_MPEG; | |
254 | f->fmt.pix.sizeimage = TS_PACKET_SIZE * dev->ts.nr_packets; | |
255 | ||
256 | return 0; | |
257 | } | |
2c10e8a8 MCC |
258 | |
259 | static int empress_reqbufs(struct file *file, void *priv, | |
260 | struct v4l2_requestbuffers *p) | |
261 | { | |
a14fe960 | 262 | struct saa7134_dev *dev = file->private_data; |
2c10e8a8 MCC |
263 | |
264 | return videobuf_reqbufs(&dev->empress_tsq, p); | |
265 | } | |
266 | ||
267 | static int empress_querybuf(struct file *file, void *priv, | |
268 | struct v4l2_buffer *b) | |
269 | { | |
a14fe960 | 270 | struct saa7134_dev *dev = file->private_data; |
2c10e8a8 MCC |
271 | |
272 | return videobuf_querybuf(&dev->empress_tsq, b); | |
273 | } | |
274 | ||
275 | static int empress_qbuf(struct file *file, void *priv, struct v4l2_buffer *b) | |
276 | { | |
a14fe960 | 277 | struct saa7134_dev *dev = file->private_data; |
2c10e8a8 MCC |
278 | |
279 | return videobuf_qbuf(&dev->empress_tsq, b); | |
280 | } | |
281 | ||
282 | static int empress_dqbuf(struct file *file, void *priv, struct v4l2_buffer *b) | |
283 | { | |
a14fe960 | 284 | struct saa7134_dev *dev = file->private_data; |
2c10e8a8 MCC |
285 | |
286 | return videobuf_dqbuf(&dev->empress_tsq, b, | |
287 | file->f_flags & O_NONBLOCK); | |
288 | } | |
289 | ||
290 | static int empress_streamon(struct file *file, void *priv, | |
291 | enum v4l2_buf_type type) | |
292 | { | |
a14fe960 | 293 | struct saa7134_dev *dev = file->private_data; |
2c10e8a8 MCC |
294 | |
295 | return videobuf_streamon(&dev->empress_tsq); | |
296 | } | |
297 | ||
298 | static int empress_streamoff(struct file *file, void *priv, | |
299 | enum v4l2_buf_type type) | |
300 | { | |
a14fe960 | 301 | struct saa7134_dev *dev = file->private_data; |
2c10e8a8 MCC |
302 | |
303 | return videobuf_streamoff(&dev->empress_tsq); | |
304 | } | |
305 | ||
306 | static int empress_s_ext_ctrls(struct file *file, void *priv, | |
307 | struct v4l2_ext_controls *ctrls) | |
308 | { | |
a14fe960 | 309 | struct saa7134_dev *dev = file->private_data; |
8b53b39d | 310 | int err; |
2c10e8a8 MCC |
311 | |
312 | /* count == 0 is abused in saa6752hs.c, so that special | |
313 | case is handled here explicitly. */ | |
314 | if (ctrls->count == 0) | |
86b79d66 | 315 | return 0; |
1da177e4 | 316 | |
2c10e8a8 MCC |
317 | if (ctrls->ctrl_class != V4L2_CTRL_CLASS_MPEG) |
318 | return -EINVAL; | |
319 | ||
fac6986c | 320 | err = saa_call_empress(dev, core, s_ext_ctrls, ctrls); |
2c10e8a8 MCC |
321 | ts_init_encoder(dev); |
322 | ||
8b53b39d | 323 | return err; |
1da177e4 LT |
324 | } |
325 | ||
2c10e8a8 MCC |
326 | static int empress_g_ext_ctrls(struct file *file, void *priv, |
327 | struct v4l2_ext_controls *ctrls) | |
1da177e4 | 328 | { |
a14fe960 | 329 | struct saa7134_dev *dev = file->private_data; |
2c10e8a8 MCC |
330 | |
331 | if (ctrls->ctrl_class != V4L2_CTRL_CLASS_MPEG) | |
332 | return -EINVAL; | |
fac6986c | 333 | return saa_call_empress(dev, core, g_ext_ctrls, ctrls); |
8b53b39d | 334 | } |
2c10e8a8 | 335 | |
531d83a3 HV |
336 | static int empress_g_ctrl(struct file *file, void *priv, |
337 | struct v4l2_control *c) | |
338 | { | |
339 | struct saa7134_dev *dev = file->private_data; | |
340 | ||
341 | return saa7134_g_ctrl_internal(dev, NULL, c); | |
342 | } | |
343 | ||
344 | static int empress_s_ctrl(struct file *file, void *priv, | |
345 | struct v4l2_control *c) | |
346 | { | |
347 | struct saa7134_dev *dev = file->private_data; | |
348 | ||
349 | return saa7134_s_ctrl_internal(dev, NULL, c); | |
350 | } | |
351 | ||
8b53b39d HV |
352 | static int empress_queryctrl(struct file *file, void *priv, |
353 | struct v4l2_queryctrl *c) | |
354 | { | |
2ba58894 | 355 | /* Must be sorted from low to high control ID! */ |
8b53b39d HV |
356 | static const u32 user_ctrls[] = { |
357 | V4L2_CID_USER_CLASS, | |
358 | V4L2_CID_BRIGHTNESS, | |
359 | V4L2_CID_CONTRAST, | |
360 | V4L2_CID_SATURATION, | |
361 | V4L2_CID_HUE, | |
362 | V4L2_CID_AUDIO_VOLUME, | |
363 | V4L2_CID_AUDIO_MUTE, | |
364 | V4L2_CID_HFLIP, | |
365 | 0 | |
366 | }; | |
367 | ||
2ba58894 | 368 | /* Must be sorted from low to high control ID! */ |
8b53b39d HV |
369 | static const u32 mpeg_ctrls[] = { |
370 | V4L2_CID_MPEG_CLASS, | |
371 | V4L2_CID_MPEG_STREAM_TYPE, | |
372 | V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ, | |
373 | V4L2_CID_MPEG_AUDIO_ENCODING, | |
374 | V4L2_CID_MPEG_AUDIO_L2_BITRATE, | |
375 | V4L2_CID_MPEG_VIDEO_ENCODING, | |
376 | V4L2_CID_MPEG_VIDEO_ASPECT, | |
377 | V4L2_CID_MPEG_VIDEO_BITRATE_MODE, | |
378 | V4L2_CID_MPEG_VIDEO_BITRATE, | |
379 | V4L2_CID_MPEG_VIDEO_BITRATE_PEAK, | |
380 | 0 | |
381 | }; | |
382 | static const u32 *ctrl_classes[] = { | |
383 | user_ctrls, | |
384 | mpeg_ctrls, | |
385 | NULL | |
386 | }; | |
387 | struct saa7134_dev *dev = file->private_data; | |
388 | ||
389 | c->id = v4l2_ctrl_next(ctrl_classes, c->id); | |
390 | if (c->id == 0) | |
391 | return -EINVAL; | |
392 | if (c->id == V4L2_CID_USER_CLASS || c->id == V4L2_CID_MPEG_CLASS) | |
10afbef1 | 393 | return v4l2_ctrl_query_fill(c, 0, 0, 0, 0); |
8b53b39d HV |
394 | if (V4L2_CTRL_ID2CLASS(c->id) != V4L2_CTRL_CLASS_MPEG) |
395 | return saa7134_queryctrl(file, priv, c); | |
fac6986c | 396 | return saa_call_empress(dev, core, queryctrl, c); |
8b53b39d HV |
397 | } |
398 | ||
399 | static int empress_querymenu(struct file *file, void *priv, | |
400 | struct v4l2_querymenu *c) | |
401 | { | |
402 | struct saa7134_dev *dev = file->private_data; | |
403 | ||
404 | if (V4L2_CTRL_ID2CLASS(c->id) != V4L2_CTRL_CLASS_MPEG) | |
405 | return -EINVAL; | |
fac6986c | 406 | return saa_call_empress(dev, core, querymenu, c); |
1da177e4 LT |
407 | } |
408 | ||
e281db58 | 409 | static int empress_g_chip_ident(struct file *file, void *fh, |
aecde8b5 | 410 | struct v4l2_dbg_chip_ident *chip) |
e281db58 HV |
411 | { |
412 | struct saa7134_dev *dev = file->private_data; | |
413 | ||
414 | chip->ident = V4L2_IDENT_NONE; | |
415 | chip->revision = 0; | |
aecde8b5 HV |
416 | if (chip->match.type == V4L2_CHIP_MATCH_I2C_DRIVER && |
417 | !strcmp(chip->match.name, "saa6752hs")) | |
fac6986c | 418 | return saa_call_empress(dev, core, g_chip_ident, chip); |
195784b8 | 419 | if (chip->match.type == V4L2_CHIP_MATCH_I2C_ADDR) |
fac6986c | 420 | return saa_call_empress(dev, core, g_chip_ident, chip); |
e281db58 HV |
421 | return -EINVAL; |
422 | } | |
423 | ||
9afb7377 HV |
424 | static int empress_s_std(struct file *file, void *priv, v4l2_std_id *id) |
425 | { | |
426 | struct saa7134_dev *dev = file->private_data; | |
427 | ||
428 | return saa7134_s_std_internal(dev, NULL, id); | |
429 | } | |
430 | ||
431 | static int empress_g_std(struct file *file, void *priv, v4l2_std_id *id) | |
432 | { | |
433 | struct saa7134_dev *dev = file->private_data; | |
434 | ||
435 | *id = dev->tvnorm->id; | |
436 | return 0; | |
437 | } | |
e281db58 | 438 | |
bec43661 | 439 | static const struct v4l2_file_operations ts_fops = |
1da177e4 LT |
440 | { |
441 | .owner = THIS_MODULE, | |
442 | .open = ts_open, | |
443 | .release = ts_release, | |
444 | .read = ts_read, | |
445 | .poll = ts_poll, | |
446 | .mmap = ts_mmap, | |
2c10e8a8 | 447 | .ioctl = video_ioctl2, |
1da177e4 LT |
448 | }; |
449 | ||
a399810c | 450 | static const struct v4l2_ioctl_ops ts_ioctl_ops = { |
2c10e8a8 | 451 | .vidioc_querycap = empress_querycap, |
78b526a4 | 452 | .vidioc_enum_fmt_vid_cap = empress_enum_fmt_vid_cap, |
6b6b7543 | 453 | .vidioc_try_fmt_vid_cap = empress_try_fmt_vid_cap, |
78b526a4 HV |
454 | .vidioc_s_fmt_vid_cap = empress_s_fmt_vid_cap, |
455 | .vidioc_g_fmt_vid_cap = empress_g_fmt_vid_cap, | |
2c10e8a8 MCC |
456 | .vidioc_reqbufs = empress_reqbufs, |
457 | .vidioc_querybuf = empress_querybuf, | |
458 | .vidioc_qbuf = empress_qbuf, | |
459 | .vidioc_dqbuf = empress_dqbuf, | |
460 | .vidioc_streamon = empress_streamon, | |
461 | .vidioc_streamoff = empress_streamoff, | |
462 | .vidioc_s_ext_ctrls = empress_s_ext_ctrls, | |
463 | .vidioc_g_ext_ctrls = empress_g_ext_ctrls, | |
464 | .vidioc_enum_input = empress_enum_input, | |
465 | .vidioc_g_input = empress_g_input, | |
466 | .vidioc_s_input = empress_s_input, | |
8b53b39d HV |
467 | .vidioc_queryctrl = empress_queryctrl, |
468 | .vidioc_querymenu = empress_querymenu, | |
531d83a3 HV |
469 | .vidioc_g_ctrl = empress_g_ctrl, |
470 | .vidioc_s_ctrl = empress_s_ctrl, | |
e281db58 | 471 | .vidioc_g_chip_ident = empress_g_chip_ident, |
9afb7377 HV |
472 | .vidioc_s_std = empress_s_std, |
473 | .vidioc_g_std = empress_g_std, | |
a399810c HV |
474 | }; |
475 | ||
476 | /* ----------------------------------------------------------- */ | |
477 | ||
478 | static struct video_device saa7134_empress_template = { | |
479 | .name = "saa7134-empress", | |
a399810c | 480 | .fops = &ts_fops, |
a399810c | 481 | .ioctl_ops = &ts_ioctl_ops, |
2c10e8a8 MCC |
482 | |
483 | .tvnorms = SAA7134_NORMS, | |
484 | .current_norm = V4L2_STD_PAL, | |
1da177e4 LT |
485 | }; |
486 | ||
c4028958 | 487 | static void empress_signal_update(struct work_struct *work) |
1da177e4 | 488 | { |
c4028958 DH |
489 | struct saa7134_dev* dev = |
490 | container_of(work, struct saa7134_dev, empress_workqueue); | |
1da177e4 LT |
491 | |
492 | if (dev->nosignal) { | |
493 | dprintk("no video signal\n"); | |
1da177e4 LT |
494 | } else { |
495 | dprintk("video signal acquired\n"); | |
1da177e4 LT |
496 | } |
497 | } | |
498 | ||
499 | static void empress_signal_change(struct saa7134_dev *dev) | |
500 | { | |
501 | schedule_work(&dev->empress_workqueue); | |
502 | } | |
503 | ||
504 | ||
505 | static int empress_init(struct saa7134_dev *dev) | |
506 | { | |
507 | int err; | |
508 | ||
5016381c | 509 | dprintk("%s: %s\n",dev->name,__func__); |
1da177e4 LT |
510 | dev->empress_dev = video_device_alloc(); |
511 | if (NULL == dev->empress_dev) | |
512 | return -ENOMEM; | |
513 | *(dev->empress_dev) = saa7134_empress_template; | |
5e85e732 | 514 | dev->empress_dev->parent = &dev->pci->dev; |
1da177e4 LT |
515 | dev->empress_dev->release = video_device_release; |
516 | snprintf(dev->empress_dev->name, sizeof(dev->empress_dev->name), | |
517 | "%s empress (%s)", dev->name, | |
518 | saa7134_boards[dev->board].name); | |
519 | ||
c4028958 | 520 | INIT_WORK(&dev->empress_workqueue, empress_signal_update); |
1da177e4 | 521 | |
63b0d5ad | 522 | video_set_drvdata(dev->empress_dev, dev); |
1da177e4 LT |
523 | err = video_register_device(dev->empress_dev,VFL_TYPE_GRABBER, |
524 | empress_nr[dev->nr]); | |
525 | if (err < 0) { | |
526 | printk(KERN_INFO "%s: can't register video device\n", | |
527 | dev->name); | |
528 | video_device_release(dev->empress_dev); | |
529 | dev->empress_dev = NULL; | |
530 | return err; | |
531 | } | |
38c7c036 LP |
532 | printk(KERN_INFO "%s: registered device %s [mpeg]\n", |
533 | dev->name, video_device_node_name(dev->empress_dev)); | |
1da177e4 | 534 | |
0705135e GL |
535 | videobuf_queue_sg_init(&dev->empress_tsq, &saa7134_ts_qops, |
536 | &dev->pci->dev, &dev->slock, | |
1da177e4 LT |
537 | V4L2_BUF_TYPE_VIDEO_CAPTURE, |
538 | V4L2_FIELD_ALTERNATE, | |
539 | sizeof(struct saa7134_buf), | |
540 | dev); | |
541 | ||
c4028958 | 542 | empress_signal_update(&dev->empress_workqueue); |
1da177e4 LT |
543 | return 0; |
544 | } | |
545 | ||
546 | static int empress_fini(struct saa7134_dev *dev) | |
547 | { | |
5016381c | 548 | dprintk("%s: %s\n",dev->name,__func__); |
1da177e4 LT |
549 | |
550 | if (NULL == dev->empress_dev) | |
551 | return 0; | |
552 | flush_scheduled_work(); | |
553 | video_unregister_device(dev->empress_dev); | |
554 | dev->empress_dev = NULL; | |
555 | return 0; | |
556 | } | |
557 | ||
558 | static struct saa7134_mpeg_ops empress_ops = { | |
559 | .type = SAA7134_MPEG_EMPRESS, | |
560 | .init = empress_init, | |
561 | .fini = empress_fini, | |
562 | .signal_change = empress_signal_change, | |
563 | }; | |
564 | ||
565 | static int __init empress_register(void) | |
566 | { | |
567 | return saa7134_ts_register(&empress_ops); | |
568 | } | |
569 | ||
570 | static void __exit empress_unregister(void) | |
571 | { | |
572 | saa7134_ts_unregister(&empress_ops); | |
573 | } | |
574 | ||
575 | module_init(empress_register); | |
576 | module_exit(empress_unregister); | |
577 | ||
578 | /* ----------------------------------------------------------- */ | |
579 | /* | |
580 | * Local variables: | |
581 | * c-basic-offset: 8 | |
582 | * End: | |
583 | */ |