1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include "cx88.h"
16
17#include <linux/module.h>
18#include <linux/init.h>
19#include <linux/slab.h>
20#include <linux/fs.h>
21#include <linux/delay.h>
22#include <linux/device.h>
23#include <linux/firmware.h>
24#include <media/v4l2-common.h>
25#include <media/v4l2-ioctl.h>
26#include <media/v4l2-event.h>
27#include <media/drv-intf/cx2341x.h>
28
29MODULE_DESCRIPTION("driver for cx2388x/cx23416 based mpeg encoder cards");
30MODULE_AUTHOR("Jelle Foks <jelle@foks.us>, Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]");
31MODULE_LICENSE("GPL v2");
32MODULE_VERSION(CX88_VERSION);
33
34static unsigned int debug;
35module_param(debug, int, 0644);
36MODULE_PARM_DESC(debug, "enable debug messages [blackbird]");
37
38#define dprintk(level, fmt, arg...) do { \
39 if (debug + 1 > level) \
40 printk(KERN_DEBUG pr_fmt("%s: blackbird:" fmt), \
41 __func__, ##arg); \
42} while (0)
43
44
45
46#define BLACKBIRD_FIRM_IMAGE_SIZE 376836
47
48
49
50#define IVTV_CMD_HW_BLOCKS_RST 0xFFFFFFFF
51
52
53#define IVTV_API_STD_TIMEOUT 500
54
55enum blackbird_capture_type {
56 BLACKBIRD_MPEG_CAPTURE,
57 BLACKBIRD_RAW_CAPTURE,
58 BLACKBIRD_RAW_PASSTHRU_CAPTURE
59};
60
61enum blackbird_capture_bits {
62 BLACKBIRD_RAW_BITS_NONE = 0x00,
63 BLACKBIRD_RAW_BITS_YUV_CAPTURE = 0x01,
64 BLACKBIRD_RAW_BITS_PCM_CAPTURE = 0x02,
65 BLACKBIRD_RAW_BITS_VBI_CAPTURE = 0x04,
66 BLACKBIRD_RAW_BITS_PASSTHRU_CAPTURE = 0x08,
67 BLACKBIRD_RAW_BITS_TO_HOST_CAPTURE = 0x10
68};
69
70enum blackbird_capture_end {
71 BLACKBIRD_END_AT_GOP,
72 BLACKBIRD_END_NOW,
73};
74
75enum blackbird_framerate {
76 BLACKBIRD_FRAMERATE_NTSC_30,
77 BLACKBIRD_FRAMERATE_PAL_25
78};
79
80enum blackbird_stream_port {
81 BLACKBIRD_OUTPUT_PORT_MEMORY,
82 BLACKBIRD_OUTPUT_PORT_STREAMING,
83 BLACKBIRD_OUTPUT_PORT_SERIAL
84};
85
86enum blackbird_data_xfer_status {
87 BLACKBIRD_MORE_BUFFERS_FOLLOW,
88 BLACKBIRD_LAST_BUFFER,
89};
90
91enum blackbird_picture_mask {
92 BLACKBIRD_PICTURE_MASK_NONE,
93 BLACKBIRD_PICTURE_MASK_I_FRAMES,
94 BLACKBIRD_PICTURE_MASK_I_P_FRAMES = 0x3,
95 BLACKBIRD_PICTURE_MASK_ALL_FRAMES = 0x7,
96};
97
98enum blackbird_vbi_mode_bits {
99 BLACKBIRD_VBI_BITS_SLICED,
100 BLACKBIRD_VBI_BITS_RAW,
101};
102
103enum blackbird_vbi_insertion_bits {
104 BLACKBIRD_VBI_BITS_INSERT_IN_XTENSION_USR_DATA,
105 BLACKBIRD_VBI_BITS_INSERT_IN_PRIVATE_PACKETS = 0x1 << 1,
106 BLACKBIRD_VBI_BITS_SEPARATE_STREAM = 0x2 << 1,
107 BLACKBIRD_VBI_BITS_SEPARATE_STREAM_USR_DATA = 0x4 << 1,
108 BLACKBIRD_VBI_BITS_SEPARATE_STREAM_PRV_DATA = 0x5 << 1,
109};
110
111enum blackbird_dma_unit {
112 BLACKBIRD_DMA_BYTES,
113 BLACKBIRD_DMA_FRAMES,
114};
115
116enum blackbird_dma_transfer_status_bits {
117 BLACKBIRD_DMA_TRANSFER_BITS_DONE = 0x01,
118 BLACKBIRD_DMA_TRANSFER_BITS_ERROR = 0x04,
119 BLACKBIRD_DMA_TRANSFER_BITS_LL_ERROR = 0x10,
120};
121
122enum blackbird_pause {
123 BLACKBIRD_PAUSE_ENCODING,
124 BLACKBIRD_RESUME_ENCODING,
125};
126
127enum blackbird_copyright {
128 BLACKBIRD_COPYRIGHT_OFF,
129 BLACKBIRD_COPYRIGHT_ON,
130};
131
132enum blackbird_notification_type {
133 BLACKBIRD_NOTIFICATION_REFRESH,
134};
135
136enum blackbird_notification_status {
137 BLACKBIRD_NOTIFICATION_OFF,
138 BLACKBIRD_NOTIFICATION_ON,
139};
140
141enum blackbird_notification_mailbox {
142 BLACKBIRD_NOTIFICATION_NO_MAILBOX = -1,
143};
144
145enum blackbird_field1_lines {
146 BLACKBIRD_FIELD1_SAA7114 = 0x00EF,
147 BLACKBIRD_FIELD1_SAA7115 = 0x00F0,
148 BLACKBIRD_FIELD1_MICRONAS = 0x0105,
149};
150
151enum blackbird_field2_lines {
152 BLACKBIRD_FIELD2_SAA7114 = 0x00EF,
153 BLACKBIRD_FIELD2_SAA7115 = 0x00F0,
154 BLACKBIRD_FIELD2_MICRONAS = 0x0106,
155};
156
157enum blackbird_custom_data_type {
158 BLACKBIRD_CUSTOM_EXTENSION_USR_DATA,
159 BLACKBIRD_CUSTOM_PRIVATE_PACKET,
160};
161
162enum blackbird_mute {
163 BLACKBIRD_UNMUTE,
164 BLACKBIRD_MUTE,
165};
166
167enum blackbird_mute_video_mask {
168 BLACKBIRD_MUTE_VIDEO_V_MASK = 0x0000FF00,
169 BLACKBIRD_MUTE_VIDEO_U_MASK = 0x00FF0000,
170 BLACKBIRD_MUTE_VIDEO_Y_MASK = 0xFF000000,
171};
172
173enum blackbird_mute_video_shift {
174 BLACKBIRD_MUTE_VIDEO_V_SHIFT = 8,
175 BLACKBIRD_MUTE_VIDEO_U_SHIFT = 16,
176 BLACKBIRD_MUTE_VIDEO_Y_SHIFT = 24,
177};
178
179
180#define IVTV_REG_ENC_SDRAM_REFRESH (0x07F8 )
181#define IVTV_REG_ENC_SDRAM_PRECHARGE (0x07FC )
182#define IVTV_REG_SPU (0x9050 )
183#define IVTV_REG_HW_BLOCKS (0x9054 )
184#define IVTV_REG_VPU (0x9058 )
185#define IVTV_REG_APU (0xA064 )
186
187
188
189static void host_setup(struct cx88_core *core)
190{
191
192 cx_write(MO_GPHST_SOFT_RST, 1);
193 udelay(100);
194 cx_write(MO_GPHST_SOFT_RST, 0);
195 udelay(100);
196
197
198 cx_write(MO_GPHST_WSC, 0x44444444U);
199 cx_write(MO_GPHST_XFR, 0);
200 cx_write(MO_GPHST_WDTH, 15);
201 cx_write(MO_GPHST_HDSHK, 0);
202 cx_write(MO_GPHST_MUX16, 0x44448888U);
203 cx_write(MO_GPHST_MODE, 0);
204}
205
206
207
208#define P1_MDATA0 0x390000
209#define P1_MDATA1 0x390001
210#define P1_MDATA2 0x390002
211#define P1_MDATA3 0x390003
212#define P1_MADDR2 0x390004
213#define P1_MADDR1 0x390005
214#define P1_MADDR0 0x390006
215#define P1_RDATA0 0x390008
216#define P1_RDATA1 0x390009
217#define P1_RDATA2 0x39000A
218#define P1_RDATA3 0x39000B
219#define P1_RADDR0 0x39000C
220#define P1_RADDR1 0x39000D
221#define P1_RRDWR 0x39000E
222
223static int wait_ready_gpio0_bit1(struct cx88_core *core, u32 state)
224{
225 unsigned long timeout = jiffies + msecs_to_jiffies(1);
226 u32 gpio0, need;
227
228 need = state ? 2 : 0;
229 for (;;) {
230 gpio0 = cx_read(MO_GP0_IO) & 2;
231 if (need == gpio0)
232 return 0;
233 if (time_after(jiffies, timeout))
234 return -1;
235 udelay(1);
236 }
237}
238
239static int memory_write(struct cx88_core *core, u32 address, u32 value)
240{
241
242 cx_writeb(P1_MDATA0, (unsigned int)value);
243 cx_writeb(P1_MDATA1, (unsigned int)(value >> 8));
244 cx_writeb(P1_MDATA2, (unsigned int)(value >> 16));
245 cx_writeb(P1_MDATA3, (unsigned int)(value >> 24));
246 cx_writeb(P1_MADDR2, (unsigned int)(address >> 16) | 0x40);
247 cx_writeb(P1_MADDR1, (unsigned int)(address >> 8));
248 cx_writeb(P1_MADDR0, (unsigned int)address);
249 cx_read(P1_MDATA0);
250 cx_read(P1_MADDR0);
251
252 return wait_ready_gpio0_bit1(core, 1);
253}
254
255static int memory_read(struct cx88_core *core, u32 address, u32 *value)
256{
257 int retval;
258 u32 val;
259
260
261 cx_writeb(P1_MADDR2, (unsigned int)(address >> 16) & ~0xC0);
262 cx_writeb(P1_MADDR1, (unsigned int)(address >> 8));
263 cx_writeb(P1_MADDR0, (unsigned int)address);
264 cx_read(P1_MADDR0);
265
266 retval = wait_ready_gpio0_bit1(core, 1);
267
268 cx_writeb(P1_MDATA3, 0);
269 val = (unsigned char)cx_read(P1_MDATA3) << 24;
270 cx_writeb(P1_MDATA2, 0);
271 val |= (unsigned char)cx_read(P1_MDATA2) << 16;
272 cx_writeb(P1_MDATA1, 0);
273 val |= (unsigned char)cx_read(P1_MDATA1) << 8;
274 cx_writeb(P1_MDATA0, 0);
275 val |= (unsigned char)cx_read(P1_MDATA0);
276
277 *value = val;
278 return retval;
279}
280
281static int register_write(struct cx88_core *core, u32 address, u32 value)
282{
283 cx_writeb(P1_RDATA0, (unsigned int)value);
284 cx_writeb(P1_RDATA1, (unsigned int)(value >> 8));
285 cx_writeb(P1_RDATA2, (unsigned int)(value >> 16));
286 cx_writeb(P1_RDATA3, (unsigned int)(value >> 24));
287 cx_writeb(P1_RADDR0, (unsigned int)address);
288 cx_writeb(P1_RADDR1, (unsigned int)(address >> 8));
289 cx_writeb(P1_RRDWR, 1);
290 cx_read(P1_RDATA0);
291 cx_read(P1_RADDR0);
292
293 return wait_ready_gpio0_bit1(core, 1);
294}
295
296static int register_read(struct cx88_core *core, u32 address, u32 *value)
297{
298 int retval;
299 u32 val;
300
301 cx_writeb(P1_RADDR0, (unsigned int)address);
302 cx_writeb(P1_RADDR1, (unsigned int)(address >> 8));
303 cx_writeb(P1_RRDWR, 0);
304 cx_read(P1_RADDR0);
305
306 retval = wait_ready_gpio0_bit1(core, 1);
307 val = (unsigned char)cx_read(P1_RDATA0);
308 val |= (unsigned char)cx_read(P1_RDATA1) << 8;
309 val |= (unsigned char)cx_read(P1_RDATA2) << 16;
310 val |= (unsigned char)cx_read(P1_RDATA3) << 24;
311
312 *value = val;
313 return retval;
314}
315
316
317
318static int blackbird_mbox_func(void *priv, u32 command, int in,
319 int out, u32 data[CX2341X_MBOX_MAX_DATA])
320{
321 struct cx8802_dev *dev = priv;
322 unsigned long timeout;
323 u32 value, flag, retval;
324 int i;
325
326 dprintk(1, "%s: 0x%X\n", __func__, command);
327
328
329
330
331
332 memory_read(dev->core, dev->mailbox - 4, &value);
333 if (value != 0x12345678) {
334 dprintk(0,
335 "Firmware and/or mailbox pointer not initialized or corrupted\n");
336 return -EIO;
337 }
338
339 memory_read(dev->core, dev->mailbox, &flag);
340 if (flag) {
341 dprintk(0, "ERROR: Mailbox appears to be in use (%x)\n", flag);
342 return -EIO;
343 }
344
345 flag |= 1;
346 memory_write(dev->core, dev->mailbox, flag);
347
348
349 memory_write(dev->core, dev->mailbox + 1, command);
350
351 memory_write(dev->core, dev->mailbox + 3, IVTV_API_STD_TIMEOUT);
352 for (i = 0; i < in; i++) {
353 memory_write(dev->core, dev->mailbox + 4 + i, data[i]);
354 dprintk(1, "API Input %d = %d\n", i, data[i]);
355 }
356 for (; i < CX2341X_MBOX_MAX_DATA; i++)
357 memory_write(dev->core, dev->mailbox + 4 + i, 0);
358
359 flag |= 3;
360 memory_write(dev->core, dev->mailbox, flag);
361
362
363 timeout = jiffies + msecs_to_jiffies(1000);
364 for (;;) {
365 memory_read(dev->core, dev->mailbox, &flag);
366 if (0 != (flag & 4))
367 break;
368 if (time_after(jiffies, timeout)) {
369 dprintk(0, "ERROR: API Mailbox timeout %x\n", command);
370 return -EIO;
371 }
372 udelay(10);
373 }
374
375
376 for (i = 0; i < out; i++) {
377 memory_read(dev->core, dev->mailbox + 4 + i, data + i);
378 dprintk(1, "API Output %d = %d\n", i, data[i]);
379 }
380
381 memory_read(dev->core, dev->mailbox + 2, &retval);
382 dprintk(1, "API result = %d\n", retval);
383
384 flag = 0;
385 memory_write(dev->core, dev->mailbox, flag);
386 return retval;
387}
388
389
390
391
392
393
394
395static int blackbird_api_cmd(struct cx8802_dev *dev, u32 command,
396 u32 inputcnt, u32 outputcnt, ...)
397{
398 u32 data[CX2341X_MBOX_MAX_DATA];
399 va_list vargs;
400 int i, err;
401
402 va_start(vargs, outputcnt);
403
404 for (i = 0; i < inputcnt; i++)
405 data[i] = va_arg(vargs, int);
406
407 err = blackbird_mbox_func(dev, command, inputcnt, outputcnt, data);
408 for (i = 0; i < outputcnt; i++) {
409 int *vptr = va_arg(vargs, int *);
410 *vptr = data[i];
411 }
412 va_end(vargs);
413 return err;
414}
415
416static int blackbird_find_mailbox(struct cx8802_dev *dev)
417{
418 u32 signature[4] = {0x12345678, 0x34567812, 0x56781234, 0x78123456};
419 int signaturecnt = 0;
420 u32 value;
421 int i;
422
423 for (i = 0; i < BLACKBIRD_FIRM_IMAGE_SIZE; i++) {
424 memory_read(dev->core, i, &value);
425 if (value == signature[signaturecnt])
426 signaturecnt++;
427 else
428 signaturecnt = 0;
429 if (signaturecnt == 4) {
430 dprintk(1, "Mailbox signature found\n");
431 return i + 1;
432 }
433 }
434 dprintk(0, "Mailbox signature values not found!\n");
435 return -EIO;
436}
437
438static int blackbird_load_firmware(struct cx8802_dev *dev)
439{
440 static const unsigned char magic[8] = {
441 0xa7, 0x0d, 0x00, 0x00, 0x66, 0xbb, 0x55, 0xaa
442 };
443 const struct firmware *firmware;
444 int i, retval = 0;
445 u32 value = 0;
446 u32 checksum = 0;
447 __le32 *dataptr;
448
449 retval = register_write(dev->core, IVTV_REG_VPU, 0xFFFFFFED);
450 retval |= register_write(dev->core, IVTV_REG_HW_BLOCKS,
451 IVTV_CMD_HW_BLOCKS_RST);
452 retval |= register_write(dev->core, IVTV_REG_ENC_SDRAM_REFRESH,
453 0x80000640);
454 retval |= register_write(dev->core, IVTV_REG_ENC_SDRAM_PRECHARGE,
455 0x1A);
456 usleep_range(10000, 20000);
457 retval |= register_write(dev->core, IVTV_REG_APU, 0);
458
459 if (retval < 0)
460 dprintk(0, "Error with register_write\n");
461
462 retval = request_firmware(&firmware, CX2341X_FIRM_ENC_FILENAME,
463 &dev->pci->dev);
464
465 if (retval != 0) {
466 pr_err("Hotplug firmware request failed (%s).\n",
467 CX2341X_FIRM_ENC_FILENAME);
468 pr_err("Please fix your hotplug setup, the board will not work without firmware loaded!\n");
469 return -EIO;
470 }
471
472 if (firmware->size != BLACKBIRD_FIRM_IMAGE_SIZE) {
473 pr_err("Firmware size mismatch (have %zd, expected %d)\n",
474 firmware->size, BLACKBIRD_FIRM_IMAGE_SIZE);
475 release_firmware(firmware);
476 return -EINVAL;
477 }
478
479 if (memcmp(firmware->data, magic, 8) != 0) {
480 pr_err("Firmware magic mismatch, wrong file?\n");
481 release_firmware(firmware);
482 return -EINVAL;
483 }
484
485
486 dprintk(1, "Loading firmware ...\n");
487 dataptr = (__le32 *)firmware->data;
488 for (i = 0; i < (firmware->size >> 2); i++) {
489 value = le32_to_cpu(*dataptr);
490 checksum += ~value;
491 memory_write(dev->core, i, value);
492 dataptr++;
493 }
494
495
496 for (i--; i >= 0; i--) {
497 memory_read(dev->core, i, &value);
498 checksum -= ~value;
499 }
500 release_firmware(firmware);
501 if (checksum) {
502 pr_err("Firmware load might have failed (checksum mismatch).\n");
503 return -EIO;
504 }
505 dprintk(0, "Firmware upload successful.\n");
506
507 retval |= register_write(dev->core, IVTV_REG_HW_BLOCKS,
508 IVTV_CMD_HW_BLOCKS_RST);
509 retval |= register_read(dev->core, IVTV_REG_SPU, &value);
510 retval |= register_write(dev->core, IVTV_REG_SPU, value & 0xFFFFFFFE);
511 usleep_range(10000, 20000);
512
513 retval |= register_read(dev->core, IVTV_REG_VPU, &value);
514 retval |= register_write(dev->core, IVTV_REG_VPU, value & 0xFFFFFFE8);
515
516 if (retval < 0)
517 dprintk(0, "Error with register_write\n");
518 return 0;
519}
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535static void blackbird_codec_settings(struct cx8802_dev *dev)
536{
537 struct cx88_core *core = dev->core;
538
539
540 blackbird_api_cmd(dev, CX2341X_ENC_SET_FRAME_SIZE, 2, 0,
541 core->height, core->width);
542
543 dev->cxhdl.width = core->width;
544 dev->cxhdl.height = core->height;
545 cx2341x_handler_set_50hz(&dev->cxhdl,
546 dev->core->tvnorm & V4L2_STD_625_50);
547 cx2341x_handler_setup(&dev->cxhdl);
548}
549
550static int blackbird_initialize_codec(struct cx8802_dev *dev)
551{
552 struct cx88_core *core = dev->core;
553 int version;
554 int retval;
555
556 dprintk(1, "Initialize codec\n");
557 retval = blackbird_api_cmd(dev, CX2341X_ENC_PING_FW, 0, 0);
558 if (retval < 0) {
559
560 cx_write(MO_SRST_IO, 0);
561 cx_write(MO_SRST_IO, 1);
562 retval = blackbird_load_firmware(dev);
563 if (retval < 0)
564 return retval;
565
566 retval = blackbird_find_mailbox(dev);
567 if (retval < 0)
568 return -1;
569
570 dev->mailbox = retval;
571
572
573 retval = blackbird_api_cmd(dev, CX2341X_ENC_PING_FW, 0, 0);
574 if (retval < 0) {
575 dprintk(0, "ERROR: Firmware ping failed!\n");
576 return -1;
577 }
578
579 retval = blackbird_api_cmd(dev, CX2341X_ENC_GET_VERSION,
580 0, 1, &version);
581 if (retval < 0) {
582 dprintk(0,
583 "ERROR: Firmware get encoder version failed!\n");
584 return -1;
585 }
586 dprintk(0, "Firmware version is 0x%08x\n", version);
587 }
588
589 cx_write(MO_PINMUX_IO, 0x88);
590 cx_clear(MO_INPUT_FORMAT, 0x100);
591 cx_write(MO_VBOS_CONTROL, 0x84A00);
592 cx_clear(MO_OUTPUT_FORMAT, 0x0008);
593
594 blackbird_codec_settings(dev);
595
596 blackbird_api_cmd(dev, CX2341X_ENC_SET_NUM_VSYNC_LINES, 2, 0,
597 BLACKBIRD_FIELD1_SAA7115, BLACKBIRD_FIELD2_SAA7115);
598
599 blackbird_api_cmd(dev, CX2341X_ENC_SET_PLACEHOLDER, 12, 0,
600 BLACKBIRD_CUSTOM_EXTENSION_USR_DATA,
601 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0);
602
603 return 0;
604}
605
606static int blackbird_start_codec(struct cx8802_dev *dev)
607{
608 struct cx88_core *core = dev->core;
609
610 u32 reg;
611
612 int i;
613 int lastchange = -1;
614 int lastval = 0;
615
616 for (i = 0; (i < 10) && (i < (lastchange + 4)); i++) {
617 reg = cx_read(AUD_STATUS);
618
619 dprintk(1, "AUD_STATUS:%dL: 0x%x\n", i, reg);
620 if ((reg & 0x0F) != lastval) {
621 lastval = reg & 0x0F;
622 lastchange = i;
623 }
624 msleep(100);
625 }
626
627
628 cx_clear(AUD_VOL_CTL, (1 << 6));
629
630 blackbird_api_cmd(dev, CX2341X_ENC_REFRESH_INPUT, 0, 0);
631
632
633 blackbird_api_cmd(dev, CX2341X_ENC_INITIALIZE_INPUT, 0, 0);
634
635 cx2341x_handler_set_busy(&dev->cxhdl, 1);
636
637
638 blackbird_api_cmd(dev, CX2341X_ENC_START_CAPTURE, 2, 0,
639 BLACKBIRD_MPEG_CAPTURE, BLACKBIRD_RAW_BITS_NONE);
640
641 return 0;
642}
643
644static int blackbird_stop_codec(struct cx8802_dev *dev)
645{
646 blackbird_api_cmd(dev, CX2341X_ENC_STOP_CAPTURE, 3, 0,
647 BLACKBIRD_END_NOW,
648 BLACKBIRD_MPEG_CAPTURE,
649 BLACKBIRD_RAW_BITS_NONE);
650
651 cx2341x_handler_set_busy(&dev->cxhdl, 0);
652
653 return 0;
654}
655
656
657
658static int queue_setup(struct vb2_queue *q,
659 unsigned int *num_buffers, unsigned int *num_planes,
660 unsigned int sizes[], struct device *alloc_devs[])
661{
662 struct cx8802_dev *dev = q->drv_priv;
663
664 *num_planes = 1;
665 dev->ts_packet_size = 188 * 4;
666 dev->ts_packet_count = 32;
667 sizes[0] = dev->ts_packet_size * dev->ts_packet_count;
668 return 0;
669}
670
671static int buffer_prepare(struct vb2_buffer *vb)
672{
673 struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
674 struct cx8802_dev *dev = vb->vb2_queue->drv_priv;
675 struct cx88_buffer *buf = container_of(vbuf, struct cx88_buffer, vb);
676
677 return cx8802_buf_prepare(vb->vb2_queue, dev, buf);
678}
679
680static void buffer_finish(struct vb2_buffer *vb)
681{
682 struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
683 struct cx8802_dev *dev = vb->vb2_queue->drv_priv;
684 struct cx88_buffer *buf = container_of(vbuf, struct cx88_buffer, vb);
685 struct cx88_riscmem *risc = &buf->risc;
686
687 if (risc->cpu)
688 pci_free_consistent(dev->pci, risc->size, risc->cpu, risc->dma);
689 memset(risc, 0, sizeof(*risc));
690}
691
692static void buffer_queue(struct vb2_buffer *vb)
693{
694 struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
695 struct cx8802_dev *dev = vb->vb2_queue->drv_priv;
696 struct cx88_buffer *buf = container_of(vbuf, struct cx88_buffer, vb);
697
698 cx8802_buf_queue(dev, buf);
699}
700
701static int start_streaming(struct vb2_queue *q, unsigned int count)
702{
703 struct cx8802_dev *dev = q->drv_priv;
704 struct cx88_dmaqueue *dmaq = &dev->mpegq;
705 struct cx8802_driver *drv;
706 struct cx88_buffer *buf;
707 unsigned long flags;
708 int err;
709
710
711 drv = cx8802_get_driver(dev, CX88_MPEG_BLACKBIRD);
712 if (!drv) {
713 dprintk(1, "%s: blackbird driver is not loaded\n", __func__);
714 err = -ENODEV;
715 goto fail;
716 }
717
718 err = drv->request_acquire(drv);
719 if (err != 0) {
720 dprintk(1, "%s: Unable to acquire hardware, %d\n", __func__,
721 err);
722 goto fail;
723 }
724
725 if (blackbird_initialize_codec(dev) < 0) {
726 drv->request_release(drv);
727 err = -EINVAL;
728 goto fail;
729 }
730
731 err = blackbird_start_codec(dev);
732 if (err == 0) {
733 buf = list_entry(dmaq->active.next, struct cx88_buffer, list);
734 cx8802_start_dma(dev, dmaq, buf);
735 return 0;
736 }
737
738fail:
739 spin_lock_irqsave(&dev->slock, flags);
740 while (!list_empty(&dmaq->active)) {
741 struct cx88_buffer *buf = list_entry(dmaq->active.next,
742 struct cx88_buffer, list);
743
744 list_del(&buf->list);
745 vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_QUEUED);
746 }
747 spin_unlock_irqrestore(&dev->slock, flags);
748 return err;
749}
750
751static void stop_streaming(struct vb2_queue *q)
752{
753 struct cx8802_dev *dev = q->drv_priv;
754 struct cx88_dmaqueue *dmaq = &dev->mpegq;
755 struct cx8802_driver *drv = NULL;
756 unsigned long flags;
757
758 cx8802_cancel_buffers(dev);
759 blackbird_stop_codec(dev);
760
761
762 drv = cx8802_get_driver(dev, CX88_MPEG_BLACKBIRD);
763 WARN_ON(!drv);
764 if (drv)
765 drv->request_release(drv);
766
767 spin_lock_irqsave(&dev->slock, flags);
768 while (!list_empty(&dmaq->active)) {
769 struct cx88_buffer *buf = list_entry(dmaq->active.next,
770 struct cx88_buffer, list);
771
772 list_del(&buf->list);
773 vb2_buffer_done(&buf->vb.vb2_buf, VB2_BUF_STATE_ERROR);
774 }
775 spin_unlock_irqrestore(&dev->slock, flags);
776}
777
778static const struct vb2_ops blackbird_qops = {
779 .queue_setup = queue_setup,
780 .buf_prepare = buffer_prepare,
781 .buf_finish = buffer_finish,
782 .buf_queue = buffer_queue,
783 .wait_prepare = vb2_ops_wait_prepare,
784 .wait_finish = vb2_ops_wait_finish,
785 .start_streaming = start_streaming,
786 .stop_streaming = stop_streaming,
787};
788
789
790
791static int vidioc_querycap(struct file *file, void *priv,
792 struct v4l2_capability *cap)
793{
794 struct cx8802_dev *dev = video_drvdata(file);
795 struct cx88_core *core = dev->core;
796
797 strscpy(cap->driver, "cx88_blackbird", sizeof(cap->driver));
798 sprintf(cap->bus_info, "PCI:%s", pci_name(dev->pci));
799 return cx88_querycap(file, core, cap);
800}
801
802static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv,
803 struct v4l2_fmtdesc *f)
804{
805 if (f->index != 0)
806 return -EINVAL;
807
808 strscpy(f->description, "MPEG", sizeof(f->description));
809 f->pixelformat = V4L2_PIX_FMT_MPEG;
810 f->flags = V4L2_FMT_FLAG_COMPRESSED;
811 return 0;
812}
813
814static int vidioc_g_fmt_vid_cap(struct file *file, void *priv,
815 struct v4l2_format *f)
816{
817 struct cx8802_dev *dev = video_drvdata(file);
818 struct cx88_core *core = dev->core;
819
820 f->fmt.pix.pixelformat = V4L2_PIX_FMT_MPEG;
821 f->fmt.pix.bytesperline = 0;
822 f->fmt.pix.sizeimage = dev->ts_packet_size * dev->ts_packet_count;
823 f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M;
824 f->fmt.pix.width = core->width;
825 f->fmt.pix.height = core->height;
826 f->fmt.pix.field = core->field;
827 return 0;
828}
829
830static int vidioc_try_fmt_vid_cap(struct file *file, void *priv,
831 struct v4l2_format *f)
832{
833 struct cx8802_dev *dev = video_drvdata(file);
834 struct cx88_core *core = dev->core;
835 unsigned int maxw, maxh;
836 enum v4l2_field field;
837
838 f->fmt.pix.pixelformat = V4L2_PIX_FMT_MPEG;
839 f->fmt.pix.bytesperline = 0;
840 f->fmt.pix.sizeimage = dev->ts_packet_size * dev->ts_packet_count;
841 f->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M;
842
843 maxw = norm_maxw(core->tvnorm);
844 maxh = norm_maxh(core->tvnorm);
845
846 field = f->fmt.pix.field;
847
848 switch (field) {
849 case V4L2_FIELD_TOP:
850 case V4L2_FIELD_BOTTOM:
851 case V4L2_FIELD_INTERLACED:
852 case V4L2_FIELD_SEQ_BT:
853 case V4L2_FIELD_SEQ_TB:
854 break;
855 default:
856 field = (f->fmt.pix.height > maxh / 2)
857 ? V4L2_FIELD_INTERLACED
858 : V4L2_FIELD_BOTTOM;
859 break;
860 }
861 if (V4L2_FIELD_HAS_T_OR_B(field))
862 maxh /= 2;
863
864 v4l_bound_align_image(&f->fmt.pix.width, 48, maxw, 2,
865 &f->fmt.pix.height, 32, maxh, 0, 0);
866 f->fmt.pix.field = field;
867 return 0;
868}
869
870static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
871 struct v4l2_format *f)
872{
873 struct cx8802_dev *dev = video_drvdata(file);
874 struct cx88_core *core = dev->core;
875
876 if (vb2_is_busy(&dev->vb2_mpegq))
877 return -EBUSY;
878 if (core->v4ldev && (vb2_is_busy(&core->v4ldev->vb2_vidq) ||
879 vb2_is_busy(&core->v4ldev->vb2_vbiq)))
880 return -EBUSY;
881 vidioc_try_fmt_vid_cap(file, priv, f);
882 core->width = f->fmt.pix.width;
883 core->height = f->fmt.pix.height;
884 core->field = f->fmt.pix.field;
885 cx88_set_scale(core, f->fmt.pix.width, f->fmt.pix.height,
886 f->fmt.pix.field);
887 blackbird_api_cmd(dev, CX2341X_ENC_SET_FRAME_SIZE, 2, 0,
888 f->fmt.pix.height, f->fmt.pix.width);
889 return 0;
890}
891
892static int vidioc_s_frequency(struct file *file, void *priv,
893 const struct v4l2_frequency *f)
894{
895 struct cx8802_dev *dev = video_drvdata(file);
896 struct cx88_core *core = dev->core;
897 bool streaming;
898
899 if (unlikely(core->board.tuner_type == UNSET))
900 return -EINVAL;
901 if (unlikely(f->tuner != 0))
902 return -EINVAL;
903 streaming = vb2_start_streaming_called(&dev->vb2_mpegq);
904 if (streaming)
905 blackbird_stop_codec(dev);
906
907 cx88_set_freq(core, f);
908 blackbird_initialize_codec(dev);
909 cx88_set_scale(core, core->width, core->height, core->field);
910 if (streaming)
911 blackbird_start_codec(dev);
912 return 0;
913}
914
915static int vidioc_log_status(struct file *file, void *priv)
916{
917 struct cx8802_dev *dev = video_drvdata(file);
918 struct cx88_core *core = dev->core;
919 char name[32 + 2];
920
921 snprintf(name, sizeof(name), "%s/2", core->name);
922 call_all(core, core, log_status);
923 v4l2_ctrl_handler_log_status(&dev->cxhdl.hdl, name);
924 return 0;
925}
926
927static int vidioc_enum_input(struct file *file, void *priv,
928 struct v4l2_input *i)
929{
930 struct cx8802_dev *dev = video_drvdata(file);
931 struct cx88_core *core = dev->core;
932
933 return cx88_enum_input(core, i);
934}
935
936static int vidioc_g_frequency(struct file *file, void *priv,
937 struct v4l2_frequency *f)
938{
939 struct cx8802_dev *dev = video_drvdata(file);
940 struct cx88_core *core = dev->core;
941
942 if (unlikely(core->board.tuner_type == UNSET))
943 return -EINVAL;
944 if (unlikely(f->tuner != 0))
945 return -EINVAL;
946
947 f->frequency = core->freq;
948 call_all(core, tuner, g_frequency, f);
949
950 return 0;
951}
952
953static int vidioc_g_input(struct file *file, void *priv, unsigned int *i)
954{
955 struct cx8802_dev *dev = video_drvdata(file);
956 struct cx88_core *core = dev->core;
957
958 *i = core->input;
959 return 0;
960}
961
962static int vidioc_s_input(struct file *file, void *priv, unsigned int i)
963{
964 struct cx8802_dev *dev = video_drvdata(file);
965 struct cx88_core *core = dev->core;
966
967 if (i >= 4)
968 return -EINVAL;
969 if (!INPUT(i).type)
970 return -EINVAL;
971
972 cx88_newstation(core);
973 cx88_video_mux(core, i);
974 return 0;
975}
976
977static int vidioc_g_tuner(struct file *file, void *priv,
978 struct v4l2_tuner *t)
979{
980 struct cx8802_dev *dev = video_drvdata(file);
981 struct cx88_core *core = dev->core;
982 u32 reg;
983
984 if (unlikely(core->board.tuner_type == UNSET))
985 return -EINVAL;
986 if (t->index != 0)
987 return -EINVAL;
988
989 strscpy(t->name, "Television", sizeof(t->name));
990 t->capability = V4L2_TUNER_CAP_NORM;
991 t->rangehigh = 0xffffffffUL;
992 call_all(core, tuner, g_tuner, t);
993
994 cx88_get_stereo(core, t);
995 reg = cx_read(MO_DEVICE_STATUS);
996 t->signal = (reg & (1 << 5)) ? 0xffff : 0x0000;
997 return 0;
998}
999
1000static int vidioc_s_tuner(struct file *file, void *priv,
1001 const struct v4l2_tuner *t)
1002{
1003 struct cx8802_dev *dev = video_drvdata(file);
1004 struct cx88_core *core = dev->core;
1005
1006 if (core->board.tuner_type == UNSET)
1007 return -EINVAL;
1008 if (t->index != 0)
1009 return -EINVAL;
1010
1011 cx88_set_stereo(core, t->audmode, 1);
1012 return 0;
1013}
1014
1015static int vidioc_g_std(struct file *file, void *priv, v4l2_std_id *tvnorm)
1016{
1017 struct cx8802_dev *dev = video_drvdata(file);
1018 struct cx88_core *core = dev->core;
1019
1020 *tvnorm = core->tvnorm;
1021 return 0;
1022}
1023
1024static int vidioc_s_std(struct file *file, void *priv, v4l2_std_id id)
1025{
1026 struct cx8802_dev *dev = video_drvdata(file);
1027 struct cx88_core *core = dev->core;
1028
1029 return cx88_set_tvnorm(core, id);
1030}
1031
1032static const struct v4l2_file_operations mpeg_fops = {
1033 .owner = THIS_MODULE,
1034 .open = v4l2_fh_open,
1035 .release = vb2_fop_release,
1036 .read = vb2_fop_read,
1037 .poll = vb2_fop_poll,
1038 .mmap = vb2_fop_mmap,
1039 .unlocked_ioctl = video_ioctl2,
1040};
1041
1042static const struct v4l2_ioctl_ops mpeg_ioctl_ops = {
1043 .vidioc_querycap = vidioc_querycap,
1044 .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap,
1045 .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap,
1046 .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap,
1047 .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap,
1048 .vidioc_reqbufs = vb2_ioctl_reqbufs,
1049 .vidioc_querybuf = vb2_ioctl_querybuf,
1050 .vidioc_qbuf = vb2_ioctl_qbuf,
1051 .vidioc_dqbuf = vb2_ioctl_dqbuf,
1052 .vidioc_streamon = vb2_ioctl_streamon,
1053 .vidioc_streamoff = vb2_ioctl_streamoff,
1054 .vidioc_s_frequency = vidioc_s_frequency,
1055 .vidioc_log_status = vidioc_log_status,
1056 .vidioc_enum_input = vidioc_enum_input,
1057 .vidioc_g_frequency = vidioc_g_frequency,
1058 .vidioc_g_input = vidioc_g_input,
1059 .vidioc_s_input = vidioc_s_input,
1060 .vidioc_g_tuner = vidioc_g_tuner,
1061 .vidioc_s_tuner = vidioc_s_tuner,
1062 .vidioc_g_std = vidioc_g_std,
1063 .vidioc_s_std = vidioc_s_std,
1064 .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
1065 .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
1066};
1067
1068static const struct video_device cx8802_mpeg_template = {
1069 .name = "cx8802",
1070 .fops = &mpeg_fops,
1071 .ioctl_ops = &mpeg_ioctl_ops,
1072 .tvnorms = CX88_NORMS,
1073};
1074
1075
1076
1077
1078static int cx8802_blackbird_advise_acquire(struct cx8802_driver *drv)
1079{
1080 struct cx88_core *core = drv->core;
1081 int err = 0;
1082
1083 switch (core->boardnr) {
1084 case CX88_BOARD_HAUPPAUGE_HVR1300:
1085
1086
1087
1088
1089
1090
1091
1092
1093 cx_set(MO_GP0_IO, 0x00000080);
1094 udelay(1000);
1095 cx_clear(MO_GP0_IO, 0x00000080);
1096 udelay(50);
1097 cx_set(MO_GP0_IO, 0x00000080);
1098 udelay(1000);
1099
1100 cx_set(MO_GP0_IO, 0x00000004);
1101 udelay(1000);
1102 break;
1103 default:
1104 err = -ENODEV;
1105 }
1106 return err;
1107}
1108
1109
1110static int cx8802_blackbird_advise_release(struct cx8802_driver *drv)
1111{
1112 struct cx88_core *core = drv->core;
1113 int err = 0;
1114
1115 switch (core->boardnr) {
1116 case CX88_BOARD_HAUPPAUGE_HVR1300:
1117
1118 break;
1119 default:
1120 err = -ENODEV;
1121 }
1122 return err;
1123}
1124
1125static void blackbird_unregister_video(struct cx8802_dev *dev)
1126{
1127 video_unregister_device(&dev->mpeg_dev);
1128}
1129
1130static int blackbird_register_video(struct cx8802_dev *dev)
1131{
1132 int err;
1133
1134 cx88_vdev_init(dev->core, dev->pci, &dev->mpeg_dev,
1135 &cx8802_mpeg_template, "mpeg");
1136 dev->mpeg_dev.ctrl_handler = &dev->cxhdl.hdl;
1137 video_set_drvdata(&dev->mpeg_dev, dev);
1138 dev->mpeg_dev.queue = &dev->vb2_mpegq;
1139 dev->mpeg_dev.device_caps = V4L2_CAP_READWRITE | V4L2_CAP_STREAMING |
1140 V4L2_CAP_VIDEO_CAPTURE;
1141 if (dev->core->board.tuner_type != UNSET)
1142 dev->mpeg_dev.device_caps |= V4L2_CAP_TUNER;
1143 err = video_register_device(&dev->mpeg_dev, VFL_TYPE_GRABBER, -1);
1144 if (err < 0) {
1145 pr_info("can't register mpeg device\n");
1146 return err;
1147 }
1148 pr_info("registered device %s [mpeg]\n",
1149 video_device_node_name(&dev->mpeg_dev));
1150 return 0;
1151}
1152
1153
1154
1155static int cx8802_blackbird_probe(struct cx8802_driver *drv)
1156{
1157 struct cx88_core *core = drv->core;
1158 struct cx8802_dev *dev = core->dvbdev;
1159 struct vb2_queue *q;
1160 int err;
1161
1162 dprintk(1, "%s\n", __func__);
1163 dprintk(1, " ->being probed by Card=%d Name=%s, PCI %02x:%02x\n",
1164 core->boardnr,
1165 core->name,
1166 core->pci_bus,
1167 core->pci_slot);
1168
1169 err = -ENODEV;
1170 if (!(core->board.mpeg & CX88_MPEG_BLACKBIRD))
1171 goto fail_core;
1172
1173 dev->cxhdl.port = CX2341X_PORT_STREAMING;
1174 dev->cxhdl.width = core->width;
1175 dev->cxhdl.height = core->height;
1176 dev->cxhdl.func = blackbird_mbox_func;
1177 dev->cxhdl.priv = dev;
1178 err = cx2341x_handler_init(&dev->cxhdl, 36);
1179 if (err)
1180 goto fail_core;
1181 v4l2_ctrl_add_handler(&dev->cxhdl.hdl, &core->video_hdl, NULL, false);
1182
1183
1184 pr_info("cx23416 based mpeg encoder (blackbird reference design)\n");
1185 host_setup(dev->core);
1186
1187 blackbird_initialize_codec(dev);
1188
1189
1190
1191 cx88_set_tvnorm(core, core->tvnorm);
1192 cx88_video_mux(core, 0);
1193 cx2341x_handler_set_50hz(&dev->cxhdl, core->height == 576);
1194 cx2341x_handler_setup(&dev->cxhdl);
1195
1196 q = &dev->vb2_mpegq;
1197 q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1198 q->io_modes = VB2_MMAP | VB2_USERPTR | VB2_DMABUF | VB2_READ;
1199 q->gfp_flags = GFP_DMA32;
1200 q->min_buffers_needed = 2;
1201 q->drv_priv = dev;
1202 q->buf_struct_size = sizeof(struct cx88_buffer);
1203 q->ops = &blackbird_qops;
1204 q->mem_ops = &vb2_dma_sg_memops;
1205 q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC;
1206 q->lock = &core->lock;
1207 q->dev = &dev->pci->dev;
1208
1209 err = vb2_queue_init(q);
1210 if (err < 0)
1211 goto fail_core;
1212
1213 blackbird_register_video(dev);
1214
1215 return 0;
1216
1217fail_core:
1218 return err;
1219}
1220
1221static int cx8802_blackbird_remove(struct cx8802_driver *drv)
1222{
1223 struct cx88_core *core = drv->core;
1224 struct cx8802_dev *dev = core->dvbdev;
1225
1226
1227 blackbird_unregister_video(drv->core->dvbdev);
1228 v4l2_ctrl_handler_free(&dev->cxhdl.hdl);
1229
1230 return 0;
1231}
1232
1233static struct cx8802_driver cx8802_blackbird_driver = {
1234 .type_id = CX88_MPEG_BLACKBIRD,
1235 .hw_access = CX8802_DRVCTL_SHARED,
1236 .probe = cx8802_blackbird_probe,
1237 .remove = cx8802_blackbird_remove,
1238 .advise_acquire = cx8802_blackbird_advise_acquire,
1239 .advise_release = cx8802_blackbird_advise_release,
1240};
1241
1242static int __init blackbird_init(void)
1243{
1244 pr_info("cx2388x blackbird driver version %s loaded\n",
1245 CX88_VERSION);
1246 return cx8802_register_driver(&cx8802_blackbird_driver);
1247}
1248
1249static void __exit blackbird_fini(void)
1250{
1251 cx8802_unregister_driver(&cx8802_blackbird_driver);
1252}
1253
1254module_init(blackbird_init);
1255module_exit(blackbird_fini);
1256
