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