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