1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * Driver for the NXP SAA7164 PCIe bridge 4 * 5 * Copyright (c) 2010-2015 Steven Toth <stoth@kernellabs.com> 6 */ 7 8 #include <linux/init.h> 9 #include <linux/list.h> 10 #include <linux/module.h> 11 #include <linux/moduleparam.h> 12 #include <linux/kmod.h> 13 #include <linux/kernel.h> 14 #include <linux/slab.h> 15 #include <linux/interrupt.h> 16 #include <linux/debugfs.h> 17 #include <linux/delay.h> 18 #include <asm/div64.h> 19 20 #include "saa7164.h" 21 22 MODULE_DESCRIPTION("Driver for NXP SAA7164 based TV cards"); 23 MODULE_AUTHOR("Steven Toth <stoth@kernellabs.com>"); 24 MODULE_LICENSE("GPL"); 25 26 /* 27 * 1 Basic 28 * 2 29 * 4 i2c 30 * 8 api 31 * 16 cmd 32 * 32 bus 33 */ 34 35 unsigned int saa_debug; 36 module_param_named(debug, saa_debug, int, 0644); 37 MODULE_PARM_DESC(debug, "enable debug messages"); 38 39 static unsigned int fw_debug; 40 module_param(fw_debug, int, 0644); 41 MODULE_PARM_DESC(fw_debug, "Firmware debug level def:2"); 42 43 unsigned int encoder_buffers = SAA7164_MAX_ENCODER_BUFFERS; 44 module_param(encoder_buffers, int, 0644); 45 MODULE_PARM_DESC(encoder_buffers, "Total buffers in read queue 16-512 def:64"); 46 47 unsigned int vbi_buffers = SAA7164_MAX_VBI_BUFFERS; 48 module_param(vbi_buffers, int, 0644); 49 MODULE_PARM_DESC(vbi_buffers, "Total buffers in read queue 16-512 def:64"); 50 51 unsigned int waitsecs = 10; 52 module_param(waitsecs, int, 0644); 53 MODULE_PARM_DESC(waitsecs, "timeout on firmware messages"); 54 55 static unsigned int card[] = {[0 ... (SAA7164_MAXBOARDS - 1)] = UNSET }; 56 module_param_array(card, int, NULL, 0444); 57 MODULE_PARM_DESC(card, "card type"); 58 59 static unsigned int print_histogram = 64; 60 module_param(print_histogram, int, 0644); 61 MODULE_PARM_DESC(print_histogram, "print histogram values once"); 62 63 unsigned int crc_checking = 1; 64 module_param(crc_checking, int, 0644); 65 MODULE_PARM_DESC(crc_checking, "enable crc sanity checking on buffers"); 66 67 static unsigned int guard_checking = 1; 68 module_param(guard_checking, int, 0644); 69 MODULE_PARM_DESC(guard_checking, 70 "enable dma sanity checking for buffer overruns"); 71 72 static bool enable_msi = true; 73 module_param(enable_msi, bool, 0444); 74 MODULE_PARM_DESC(enable_msi, 75 "enable the use of an msi interrupt if available"); 76 77 static unsigned int saa7164_devcount; 78 79 static DEFINE_MUTEX(devlist); 80 LIST_HEAD(saa7164_devlist); 81 82 #define INT_SIZE 16 83 84 static void saa7164_pack_verifier(struct saa7164_buffer *buf) 85 { 86 u8 *p = (u8 *)buf->cpu; 87 int i; 88 89 for (i = 0; i < buf->actual_size; i += 2048) { 90 91 if ((*(p + i + 0) != 0x00) || (*(p + i + 1) != 0x00) || 92 (*(p + i + 2) != 0x01) || (*(p + i + 3) != 0xBA)) { 93 printk(KERN_ERR "No pack at 0x%x\n", i); 94 #if 0 95 print_hex_dump(KERN_INFO, "", DUMP_PREFIX_OFFSET, 16, 1, 96 p + 1, 32, false); 97 #endif 98 } 99 } 100 } 101 102 #define FIXED_VIDEO_PID 0xf1 103 #define FIXED_AUDIO_PID 0xf2 104 105 static void saa7164_ts_verifier(struct saa7164_buffer *buf) 106 { 107 struct saa7164_port *port = buf->port; 108 u32 i; 109 u8 cc, a; 110 u16 pid; 111 u8 *bufcpu = (u8 *)buf->cpu; 112 113 port->sync_errors = 0; 114 port->v_cc_errors = 0; 115 port->a_cc_errors = 0; 116 117 for (i = 0; i < buf->actual_size; i += 188) { 118 if (*(bufcpu + i) != 0x47) 119 port->sync_errors++; 120 121 /* TODO: Query pid lower 8 bits, ignoring upper bits intensionally */ 122 pid = ((*(bufcpu + i + 1) & 0x1f) << 8) | *(bufcpu + i + 2); 123 cc = *(bufcpu + i + 3) & 0x0f; 124 125 if (pid == FIXED_VIDEO_PID) { 126 a = ((port->last_v_cc + 1) & 0x0f); 127 if (a != cc) { 128 printk(KERN_ERR "video cc last = %x current = %x i = %d\n", 129 port->last_v_cc, cc, i); 130 port->v_cc_errors++; 131 } 132 133 port->last_v_cc = cc; 134 } else 135 if (pid == FIXED_AUDIO_PID) { 136 a = ((port->last_a_cc + 1) & 0x0f); 137 if (a != cc) { 138 printk(KERN_ERR "audio cc last = %x current = %x i = %d\n", 139 port->last_a_cc, cc, i); 140 port->a_cc_errors++; 141 } 142 143 port->last_a_cc = cc; 144 } 145 146 } 147 148 /* Only report errors if we've been through this function at least 149 * once already and the cached cc values are primed. First time through 150 * always generates errors. 151 */ 152 if (port->v_cc_errors && (port->done_first_interrupt > 1)) 153 printk(KERN_ERR "video pid cc, %d errors\n", port->v_cc_errors); 154 155 if (port->a_cc_errors && (port->done_first_interrupt > 1)) 156 printk(KERN_ERR "audio pid cc, %d errors\n", port->a_cc_errors); 157 158 if (port->sync_errors && (port->done_first_interrupt > 1)) 159 printk(KERN_ERR "sync_errors = %d\n", port->sync_errors); 160 161 if (port->done_first_interrupt == 1) 162 port->done_first_interrupt++; 163 } 164 165 static void saa7164_histogram_reset(struct saa7164_histogram *hg, char *name) 166 { 167 int i; 168 169 memset(hg, 0, sizeof(struct saa7164_histogram)); 170 strscpy(hg->name, name, sizeof(hg->name)); 171 172 /* First 30ms x 1ms */ 173 for (i = 0; i < 30; i++) 174 hg->counter1[0 + i].val = i; 175 176 /* 30 - 200ms x 10ms */ 177 for (i = 0; i < 18; i++) 178 hg->counter1[30 + i].val = 30 + (i * 10); 179 180 /* 200 - 2000ms x 100ms */ 181 for (i = 0; i < 15; i++) 182 hg->counter1[48 + i].val = 200 + (i * 200); 183 184 /* Catch all massive value (2secs) */ 185 hg->counter1[55].val = 2000; 186 187 /* Catch all massive value (4secs) */ 188 hg->counter1[56].val = 4000; 189 190 /* Catch all massive value (8secs) */ 191 hg->counter1[57].val = 8000; 192 193 /* Catch all massive value (15secs) */ 194 hg->counter1[58].val = 15000; 195 196 /* Catch all massive value (30secs) */ 197 hg->counter1[59].val = 30000; 198 199 /* Catch all massive value (60secs) */ 200 hg->counter1[60].val = 60000; 201 202 /* Catch all massive value (5mins) */ 203 hg->counter1[61].val = 300000; 204 205 /* Catch all massive value (15mins) */ 206 hg->counter1[62].val = 900000; 207 208 /* Catch all massive values (1hr) */ 209 hg->counter1[63].val = 3600000; 210 } 211 212 void saa7164_histogram_update(struct saa7164_histogram *hg, u32 val) 213 { 214 int i; 215 for (i = 0; i < 64; i++) { 216 if (val <= hg->counter1[i].val) { 217 hg->counter1[i].count++; 218 hg->counter1[i].update_time = jiffies; 219 break; 220 } 221 } 222 } 223 224 static void saa7164_histogram_print(struct saa7164_port *port, 225 struct saa7164_histogram *hg) 226 { 227 u32 entries = 0; 228 int i; 229 230 printk(KERN_ERR "Histogram named %s (ms, count, last_update_jiffy)\n", hg->name); 231 for (i = 0; i < 64; i++) { 232 if (hg->counter1[i].count == 0) 233 continue; 234 235 printk(KERN_ERR " %4d %12d %Ld\n", 236 hg->counter1[i].val, 237 hg->counter1[i].count, 238 hg->counter1[i].update_time); 239 240 entries++; 241 } 242 printk(KERN_ERR "Total: %d\n", entries); 243 } 244 245 static void saa7164_work_enchandler_helper(struct saa7164_port *port, int bufnr) 246 { 247 struct saa7164_dev *dev = port->dev; 248 struct saa7164_buffer *buf = NULL; 249 struct saa7164_user_buffer *ubuf = NULL; 250 struct list_head *c, *n; 251 int i = 0; 252 u8 *p; 253 254 mutex_lock(&port->dmaqueue_lock); 255 list_for_each_safe(c, n, &port->dmaqueue.list) { 256 257 buf = list_entry(c, struct saa7164_buffer, list); 258 if (i++ > port->hwcfg.buffercount) { 259 printk(KERN_ERR "%s() illegal i count %d\n", 260 __func__, i); 261 break; 262 } 263 264 if (buf->idx == bufnr) { 265 266 /* Found the buffer, deal with it */ 267 dprintk(DBGLVL_IRQ, "%s() bufnr: %d\n", __func__, bufnr); 268 269 if (crc_checking) { 270 /* Throw a new checksum on the dma buffer */ 271 buf->crc = crc32(0, buf->cpu, buf->actual_size); 272 } 273 274 if (guard_checking) { 275 p = (u8 *)buf->cpu; 276 if ((*(p + buf->actual_size + 0) != 0xff) || 277 (*(p + buf->actual_size + 1) != 0xff) || 278 (*(p + buf->actual_size + 2) != 0xff) || 279 (*(p + buf->actual_size + 3) != 0xff) || 280 (*(p + buf->actual_size + 0x10) != 0xff) || 281 (*(p + buf->actual_size + 0x11) != 0xff) || 282 (*(p + buf->actual_size + 0x12) != 0xff) || 283 (*(p + buf->actual_size + 0x13) != 0xff)) { 284 printk(KERN_ERR "%s() buf %p guard buffer breach\n", 285 __func__, buf); 286 #if 0 287 print_hex_dump(KERN_INFO, "", DUMP_PREFIX_OFFSET, 16, 1, 288 p + buf->actual_size - 32, 64, false); 289 #endif 290 } 291 } 292 293 if ((port->nr != SAA7164_PORT_VBI1) && (port->nr != SAA7164_PORT_VBI2)) { 294 /* Validate the incoming buffer content */ 295 if (port->encoder_params.stream_type == V4L2_MPEG_STREAM_TYPE_MPEG2_TS) 296 saa7164_ts_verifier(buf); 297 else if (port->encoder_params.stream_type == V4L2_MPEG_STREAM_TYPE_MPEG2_PS) 298 saa7164_pack_verifier(buf); 299 } 300 301 /* find a free user buffer and clone to it */ 302 if (!list_empty(&port->list_buf_free.list)) { 303 304 /* Pull the first buffer from the used list */ 305 ubuf = list_first_entry(&port->list_buf_free.list, 306 struct saa7164_user_buffer, list); 307 308 if (buf->actual_size <= ubuf->actual_size) { 309 310 memcpy(ubuf->data, buf->cpu, ubuf->actual_size); 311 312 if (crc_checking) { 313 /* Throw a new checksum on the read buffer */ 314 ubuf->crc = crc32(0, ubuf->data, ubuf->actual_size); 315 } 316 317 /* Requeue the buffer on the free list */ 318 ubuf->pos = 0; 319 320 list_move_tail(&ubuf->list, 321 &port->list_buf_used.list); 322 323 /* Flag any userland waiters */ 324 wake_up_interruptible(&port->wait_read); 325 326 } else { 327 printk(KERN_ERR "buf %p bufsize fails match\n", buf); 328 } 329 330 } else 331 printk(KERN_ERR "encirq no free buffers, increase param encoder_buffers\n"); 332 333 /* Ensure offset into buffer remains 0, fill buffer 334 * with known bad data. We check for this data at a later point 335 * in time. */ 336 saa7164_buffer_zero_offsets(port, bufnr); 337 memset(buf->cpu, 0xff, buf->pci_size); 338 if (crc_checking) { 339 /* Throw yet aanother new checksum on the dma buffer */ 340 buf->crc = crc32(0, buf->cpu, buf->actual_size); 341 } 342 343 break; 344 } 345 } 346 mutex_unlock(&port->dmaqueue_lock); 347 } 348 349 static void saa7164_work_enchandler(struct work_struct *w) 350 { 351 struct saa7164_port *port = 352 container_of(w, struct saa7164_port, workenc); 353 struct saa7164_dev *dev = port->dev; 354 355 u32 wp, mcb, rp, cnt = 0; 356 357 port->last_svc_msecs_diff = port->last_svc_msecs; 358 port->last_svc_msecs = jiffies_to_msecs(jiffies); 359 360 port->last_svc_msecs_diff = port->last_svc_msecs - 361 port->last_svc_msecs_diff; 362 363 saa7164_histogram_update(&port->svc_interval, 364 port->last_svc_msecs_diff); 365 366 port->last_irq_svc_msecs_diff = port->last_svc_msecs - 367 port->last_irq_msecs; 368 369 saa7164_histogram_update(&port->irq_svc_interval, 370 port->last_irq_svc_msecs_diff); 371 372 dprintk(DBGLVL_IRQ, 373 "%s() %Ldms elapsed irq->deferred %Ldms wp: %d rp: %d\n", 374 __func__, 375 port->last_svc_msecs_diff, 376 port->last_irq_svc_msecs_diff, 377 port->last_svc_wp, 378 port->last_svc_rp 379 ); 380 381 /* Current write position */ 382 wp = saa7164_readl(port->bufcounter); 383 if (wp > (port->hwcfg.buffercount - 1)) { 384 printk(KERN_ERR "%s() illegal buf count %d\n", __func__, wp); 385 return; 386 } 387 388 /* Most current complete buffer */ 389 if (wp == 0) 390 mcb = (port->hwcfg.buffercount - 1); 391 else 392 mcb = wp - 1; 393 394 while (1) { 395 if (port->done_first_interrupt == 0) { 396 port->done_first_interrupt++; 397 rp = mcb; 398 } else 399 rp = (port->last_svc_rp + 1) % 8; 400 401 if (rp > (port->hwcfg.buffercount - 1)) { 402 printk(KERN_ERR "%s() illegal rp count %d\n", __func__, rp); 403 break; 404 } 405 406 saa7164_work_enchandler_helper(port, rp); 407 port->last_svc_rp = rp; 408 cnt++; 409 410 if (rp == mcb) 411 break; 412 } 413 414 /* TODO: Convert this into a /proc/saa7164 style readable file */ 415 if (print_histogram == port->nr) { 416 saa7164_histogram_print(port, &port->irq_interval); 417 saa7164_histogram_print(port, &port->svc_interval); 418 saa7164_histogram_print(port, &port->irq_svc_interval); 419 saa7164_histogram_print(port, &port->read_interval); 420 saa7164_histogram_print(port, &port->poll_interval); 421 /* TODO: fix this to preserve any previous state */ 422 print_histogram = 64 + port->nr; 423 } 424 } 425 426 static void saa7164_work_vbihandler(struct work_struct *w) 427 { 428 struct saa7164_port *port = 429 container_of(w, struct saa7164_port, workenc); 430 struct saa7164_dev *dev = port->dev; 431 432 u32 wp, mcb, rp, cnt = 0; 433 434 port->last_svc_msecs_diff = port->last_svc_msecs; 435 port->last_svc_msecs = jiffies_to_msecs(jiffies); 436 port->last_svc_msecs_diff = port->last_svc_msecs - 437 port->last_svc_msecs_diff; 438 439 saa7164_histogram_update(&port->svc_interval, 440 port->last_svc_msecs_diff); 441 442 port->last_irq_svc_msecs_diff = port->last_svc_msecs - 443 port->last_irq_msecs; 444 445 saa7164_histogram_update(&port->irq_svc_interval, 446 port->last_irq_svc_msecs_diff); 447 448 dprintk(DBGLVL_IRQ, 449 "%s() %Ldms elapsed irq->deferred %Ldms wp: %d rp: %d\n", 450 __func__, 451 port->last_svc_msecs_diff, 452 port->last_irq_svc_msecs_diff, 453 port->last_svc_wp, 454 port->last_svc_rp 455 ); 456 457 /* Current write position */ 458 wp = saa7164_readl(port->bufcounter); 459 if (wp > (port->hwcfg.buffercount - 1)) { 460 printk(KERN_ERR "%s() illegal buf count %d\n", __func__, wp); 461 return; 462 } 463 464 /* Most current complete buffer */ 465 if (wp == 0) 466 mcb = (port->hwcfg.buffercount - 1); 467 else 468 mcb = wp - 1; 469 470 while (1) { 471 if (port->done_first_interrupt == 0) { 472 port->done_first_interrupt++; 473 rp = mcb; 474 } else 475 rp = (port->last_svc_rp + 1) % 8; 476 477 if (rp > (port->hwcfg.buffercount - 1)) { 478 printk(KERN_ERR "%s() illegal rp count %d\n", __func__, rp); 479 break; 480 } 481 482 saa7164_work_enchandler_helper(port, rp); 483 port->last_svc_rp = rp; 484 cnt++; 485 486 if (rp == mcb) 487 break; 488 } 489 490 /* TODO: Convert this into a /proc/saa7164 style readable file */ 491 if (print_histogram == port->nr) { 492 saa7164_histogram_print(port, &port->irq_interval); 493 saa7164_histogram_print(port, &port->svc_interval); 494 saa7164_histogram_print(port, &port->irq_svc_interval); 495 saa7164_histogram_print(port, &port->read_interval); 496 saa7164_histogram_print(port, &port->poll_interval); 497 /* TODO: fix this to preserve any previous state */ 498 print_histogram = 64 + port->nr; 499 } 500 } 501 502 static void saa7164_work_cmdhandler(struct work_struct *w) 503 { 504 struct saa7164_dev *dev = container_of(w, struct saa7164_dev, workcmd); 505 506 /* Wake up any complete commands */ 507 saa7164_irq_dequeue(dev); 508 } 509 510 static void saa7164_buffer_deliver(struct saa7164_buffer *buf) 511 { 512 struct saa7164_port *port = buf->port; 513 514 /* Feed the transport payload into the kernel demux */ 515 dvb_dmx_swfilter_packets(&port->dvb.demux, (u8 *)buf->cpu, 516 SAA7164_TS_NUMBER_OF_LINES); 517 518 } 519 520 static irqreturn_t saa7164_irq_vbi(struct saa7164_port *port) 521 { 522 struct saa7164_dev *dev = port->dev; 523 524 /* Store old time */ 525 port->last_irq_msecs_diff = port->last_irq_msecs; 526 527 /* Collect new stats */ 528 port->last_irq_msecs = jiffies_to_msecs(jiffies); 529 530 /* Calculate stats */ 531 port->last_irq_msecs_diff = port->last_irq_msecs - 532 port->last_irq_msecs_diff; 533 534 saa7164_histogram_update(&port->irq_interval, 535 port->last_irq_msecs_diff); 536 537 dprintk(DBGLVL_IRQ, "%s() %Ldms elapsed\n", __func__, 538 port->last_irq_msecs_diff); 539 540 /* Tis calls the vbi irq handler */ 541 schedule_work(&port->workenc); 542 return 0; 543 } 544 545 static irqreturn_t saa7164_irq_encoder(struct saa7164_port *port) 546 { 547 struct saa7164_dev *dev = port->dev; 548 549 /* Store old time */ 550 port->last_irq_msecs_diff = port->last_irq_msecs; 551 552 /* Collect new stats */ 553 port->last_irq_msecs = jiffies_to_msecs(jiffies); 554 555 /* Calculate stats */ 556 port->last_irq_msecs_diff = port->last_irq_msecs - 557 port->last_irq_msecs_diff; 558 559 saa7164_histogram_update(&port->irq_interval, 560 port->last_irq_msecs_diff); 561 562 dprintk(DBGLVL_IRQ, "%s() %Ldms elapsed\n", __func__, 563 port->last_irq_msecs_diff); 564 565 schedule_work(&port->workenc); 566 return 0; 567 } 568 569 static irqreturn_t saa7164_irq_ts(struct saa7164_port *port) 570 { 571 struct saa7164_dev *dev = port->dev; 572 struct saa7164_buffer *buf; 573 struct list_head *c, *n; 574 int wp, i = 0, rp; 575 576 /* Find the current write point from the hardware */ 577 wp = saa7164_readl(port->bufcounter); 578 579 BUG_ON(wp > (port->hwcfg.buffercount - 1)); 580 581 /* Find the previous buffer to the current write point */ 582 if (wp == 0) 583 rp = (port->hwcfg.buffercount - 1); 584 else 585 rp = wp - 1; 586 587 /* Lookup the WP in the buffer list */ 588 /* TODO: turn this into a worker thread */ 589 list_for_each_safe(c, n, &port->dmaqueue.list) { 590 buf = list_entry(c, struct saa7164_buffer, list); 591 BUG_ON(i > port->hwcfg.buffercount); 592 i++; 593 594 if (buf->idx == rp) { 595 /* Found the buffer, deal with it */ 596 dprintk(DBGLVL_IRQ, "%s() wp: %d processing: %d\n", 597 __func__, wp, rp); 598 saa7164_buffer_deliver(buf); 599 break; 600 } 601 602 } 603 return 0; 604 } 605 606 /* Primary IRQ handler and dispatch mechanism */ 607 static irqreturn_t saa7164_irq(int irq, void *dev_id) 608 { 609 struct saa7164_dev *dev = dev_id; 610 struct saa7164_port *porta, *portb, *portc, *portd, *porte, *portf; 611 612 u32 intid, intstat[INT_SIZE/4]; 613 int i, handled = 0, bit; 614 615 if (dev == NULL) { 616 printk(KERN_ERR "%s() No device specified\n", __func__); 617 handled = 0; 618 goto out; 619 } 620 621 porta = &dev->ports[SAA7164_PORT_TS1]; 622 portb = &dev->ports[SAA7164_PORT_TS2]; 623 portc = &dev->ports[SAA7164_PORT_ENC1]; 624 portd = &dev->ports[SAA7164_PORT_ENC2]; 625 porte = &dev->ports[SAA7164_PORT_VBI1]; 626 portf = &dev->ports[SAA7164_PORT_VBI2]; 627 628 /* Check that the hardware is accessible. If the status bytes are 629 * 0xFF then the device is not accessible, the the IRQ belongs 630 * to another driver. 631 * 4 x u32 interrupt registers. 632 */ 633 for (i = 0; i < INT_SIZE/4; i++) { 634 635 /* TODO: Convert into saa7164_readl() */ 636 /* Read the 4 hardware interrupt registers */ 637 intstat[i] = saa7164_readl(dev->int_status + (i * 4)); 638 639 if (intstat[i]) 640 handled = 1; 641 } 642 if (handled == 0) 643 goto out; 644 645 /* For each of the HW interrupt registers */ 646 for (i = 0; i < INT_SIZE/4; i++) { 647 648 if (intstat[i]) { 649 /* Each function of the board has it's own interruptid. 650 * Find the function that triggered then call 651 * it's handler. 652 */ 653 for (bit = 0; bit < 32; bit++) { 654 655 if (((intstat[i] >> bit) & 0x00000001) == 0) 656 continue; 657 658 /* Calculate the interrupt id (0x00 to 0x7f) */ 659 660 intid = (i * 32) + bit; 661 if (intid == dev->intfdesc.bInterruptId) { 662 /* A response to an cmd/api call */ 663 schedule_work(&dev->workcmd); 664 } else if (intid == porta->hwcfg.interruptid) { 665 666 /* Transport path 1 */ 667 saa7164_irq_ts(porta); 668 669 } else if (intid == portb->hwcfg.interruptid) { 670 671 /* Transport path 2 */ 672 saa7164_irq_ts(portb); 673 674 } else if (intid == portc->hwcfg.interruptid) { 675 676 /* Encoder path 1 */ 677 saa7164_irq_encoder(portc); 678 679 } else if (intid == portd->hwcfg.interruptid) { 680 681 /* Encoder path 2 */ 682 saa7164_irq_encoder(portd); 683 684 } else if (intid == porte->hwcfg.interruptid) { 685 686 /* VBI path 1 */ 687 saa7164_irq_vbi(porte); 688 689 } else if (intid == portf->hwcfg.interruptid) { 690 691 /* VBI path 2 */ 692 saa7164_irq_vbi(portf); 693 694 } else { 695 /* Find the function */ 696 dprintk(DBGLVL_IRQ, 697 "%s() unhandled interrupt reg 0x%x bit 0x%x intid = 0x%x\n", 698 __func__, i, bit, intid); 699 } 700 } 701 702 /* Ack it */ 703 saa7164_writel(dev->int_ack + (i * 4), intstat[i]); 704 705 } 706 } 707 out: 708 return IRQ_RETVAL(handled); 709 } 710 711 void saa7164_getfirmwarestatus(struct saa7164_dev *dev) 712 { 713 struct saa7164_fw_status *s = &dev->fw_status; 714 715 dev->fw_status.status = saa7164_readl(SAA_DEVICE_SYSINIT_STATUS); 716 dev->fw_status.mode = saa7164_readl(SAA_DEVICE_SYSINIT_MODE); 717 dev->fw_status.spec = saa7164_readl(SAA_DEVICE_SYSINIT_SPEC); 718 dev->fw_status.inst = saa7164_readl(SAA_DEVICE_SYSINIT_INST); 719 dev->fw_status.cpuload = saa7164_readl(SAA_DEVICE_SYSINIT_CPULOAD); 720 dev->fw_status.remainheap = 721 saa7164_readl(SAA_DEVICE_SYSINIT_REMAINHEAP); 722 723 dprintk(1, "Firmware status:\n"); 724 dprintk(1, " .status = 0x%08x\n", s->status); 725 dprintk(1, " .mode = 0x%08x\n", s->mode); 726 dprintk(1, " .spec = 0x%08x\n", s->spec); 727 dprintk(1, " .inst = 0x%08x\n", s->inst); 728 dprintk(1, " .cpuload = 0x%08x\n", s->cpuload); 729 dprintk(1, " .remainheap = 0x%08x\n", s->remainheap); 730 } 731 732 u32 saa7164_getcurrentfirmwareversion(struct saa7164_dev *dev) 733 { 734 u32 reg; 735 736 reg = saa7164_readl(SAA_DEVICE_VERSION); 737 dprintk(1, "Device running firmware version %d.%d.%d.%d (0x%x)\n", 738 (reg & 0x0000fc00) >> 10, 739 (reg & 0x000003e0) >> 5, 740 (reg & 0x0000001f), 741 (reg & 0xffff0000) >> 16, 742 reg); 743 744 return reg; 745 } 746 747 /* TODO: Debugging func, remove */ 748 void saa7164_dumpregs(struct saa7164_dev *dev, u32 addr) 749 { 750 int i; 751 752 dprintk(1, "--------------------> 00 01 02 03 04 05 06 07 08 09 0a 0b 0c 0d 0e 0f\n"); 753 754 for (i = 0; i < 0x100; i += 16) 755 dprintk(1, "region0[0x%08x] = %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x %02x\n", 756 i, 757 (u8)saa7164_readb(addr + i + 0), 758 (u8)saa7164_readb(addr + i + 1), 759 (u8)saa7164_readb(addr + i + 2), 760 (u8)saa7164_readb(addr + i + 3), 761 (u8)saa7164_readb(addr + i + 4), 762 (u8)saa7164_readb(addr + i + 5), 763 (u8)saa7164_readb(addr + i + 6), 764 (u8)saa7164_readb(addr + i + 7), 765 (u8)saa7164_readb(addr + i + 8), 766 (u8)saa7164_readb(addr + i + 9), 767 (u8)saa7164_readb(addr + i + 10), 768 (u8)saa7164_readb(addr + i + 11), 769 (u8)saa7164_readb(addr + i + 12), 770 (u8)saa7164_readb(addr + i + 13), 771 (u8)saa7164_readb(addr + i + 14), 772 (u8)saa7164_readb(addr + i + 15) 773 ); 774 } 775 776 static void saa7164_dump_hwdesc(struct saa7164_dev *dev) 777 { 778 dprintk(1, "@0x%p hwdesc sizeof(struct tmComResHWDescr) = %d bytes\n", 779 &dev->hwdesc, (u32)sizeof(struct tmComResHWDescr)); 780 781 dprintk(1, " .bLength = 0x%x\n", dev->hwdesc.bLength); 782 dprintk(1, " .bDescriptorType = 0x%x\n", dev->hwdesc.bDescriptorType); 783 dprintk(1, " .bDescriptorSubtype = 0x%x\n", 784 dev->hwdesc.bDescriptorSubtype); 785 786 dprintk(1, " .bcdSpecVersion = 0x%x\n", dev->hwdesc.bcdSpecVersion); 787 dprintk(1, " .dwClockFrequency = 0x%x\n", dev->hwdesc.dwClockFrequency); 788 dprintk(1, " .dwClockUpdateRes = 0x%x\n", dev->hwdesc.dwClockUpdateRes); 789 dprintk(1, " .bCapabilities = 0x%x\n", dev->hwdesc.bCapabilities); 790 dprintk(1, " .dwDeviceRegistersLocation = 0x%x\n", 791 dev->hwdesc.dwDeviceRegistersLocation); 792 793 dprintk(1, " .dwHostMemoryRegion = 0x%x\n", 794 dev->hwdesc.dwHostMemoryRegion); 795 796 dprintk(1, " .dwHostMemoryRegionSize = 0x%x\n", 797 dev->hwdesc.dwHostMemoryRegionSize); 798 799 dprintk(1, " .dwHostHibernatMemRegion = 0x%x\n", 800 dev->hwdesc.dwHostHibernatMemRegion); 801 802 dprintk(1, " .dwHostHibernatMemRegionSize = 0x%x\n", 803 dev->hwdesc.dwHostHibernatMemRegionSize); 804 } 805 806 static void saa7164_dump_intfdesc(struct saa7164_dev *dev) 807 { 808 dprintk(1, "@0x%p intfdesc sizeof(struct tmComResInterfaceDescr) = %d bytes\n", 809 &dev->intfdesc, (u32)sizeof(struct tmComResInterfaceDescr)); 810 811 dprintk(1, " .bLength = 0x%x\n", dev->intfdesc.bLength); 812 dprintk(1, " .bDescriptorType = 0x%x\n", dev->intfdesc.bDescriptorType); 813 dprintk(1, " .bDescriptorSubtype = 0x%x\n", 814 dev->intfdesc.bDescriptorSubtype); 815 816 dprintk(1, " .bFlags = 0x%x\n", dev->intfdesc.bFlags); 817 dprintk(1, " .bInterfaceType = 0x%x\n", dev->intfdesc.bInterfaceType); 818 dprintk(1, " .bInterfaceId = 0x%x\n", dev->intfdesc.bInterfaceId); 819 dprintk(1, " .bBaseInterface = 0x%x\n", dev->intfdesc.bBaseInterface); 820 dprintk(1, " .bInterruptId = 0x%x\n", dev->intfdesc.bInterruptId); 821 dprintk(1, " .bDebugInterruptId = 0x%x\n", 822 dev->intfdesc.bDebugInterruptId); 823 824 dprintk(1, " .BARLocation = 0x%x\n", dev->intfdesc.BARLocation); 825 } 826 827 static void saa7164_dump_busdesc(struct saa7164_dev *dev) 828 { 829 dprintk(1, "@0x%p busdesc sizeof(struct tmComResBusDescr) = %d bytes\n", 830 &dev->busdesc, (u32)sizeof(struct tmComResBusDescr)); 831 832 dprintk(1, " .CommandRing = 0x%016Lx\n", dev->busdesc.CommandRing); 833 dprintk(1, " .ResponseRing = 0x%016Lx\n", dev->busdesc.ResponseRing); 834 dprintk(1, " .CommandWrite = 0x%x\n", dev->busdesc.CommandWrite); 835 dprintk(1, " .CommandRead = 0x%x\n", dev->busdesc.CommandRead); 836 dprintk(1, " .ResponseWrite = 0x%x\n", dev->busdesc.ResponseWrite); 837 dprintk(1, " .ResponseRead = 0x%x\n", dev->busdesc.ResponseRead); 838 } 839 840 /* Much of the hardware configuration and PCI registers are configured 841 * dynamically depending on firmware. We have to cache some initial 842 * structures then use these to locate other important structures 843 * from PCI space. 844 */ 845 static void saa7164_get_descriptors(struct saa7164_dev *dev) 846 { 847 memcpy_fromio(&dev->hwdesc, dev->bmmio, sizeof(struct tmComResHWDescr)); 848 memcpy_fromio(&dev->intfdesc, dev->bmmio + sizeof(struct tmComResHWDescr), 849 sizeof(struct tmComResInterfaceDescr)); 850 memcpy_fromio(&dev->busdesc, dev->bmmio + dev->intfdesc.BARLocation, 851 sizeof(struct tmComResBusDescr)); 852 853 if (dev->hwdesc.bLength != sizeof(struct tmComResHWDescr)) { 854 printk(KERN_ERR "Structure struct tmComResHWDescr is mangled\n"); 855 printk(KERN_ERR "Need %x got %d\n", dev->hwdesc.bLength, 856 (u32)sizeof(struct tmComResHWDescr)); 857 } else 858 saa7164_dump_hwdesc(dev); 859 860 if (dev->intfdesc.bLength != sizeof(struct tmComResInterfaceDescr)) { 861 printk(KERN_ERR "struct struct tmComResInterfaceDescr is mangled\n"); 862 printk(KERN_ERR "Need %x got %d\n", dev->intfdesc.bLength, 863 (u32)sizeof(struct tmComResInterfaceDescr)); 864 } else 865 saa7164_dump_intfdesc(dev); 866 867 saa7164_dump_busdesc(dev); 868 } 869 870 static int saa7164_pci_quirks(struct saa7164_dev *dev) 871 { 872 return 0; 873 } 874 875 static int get_resources(struct saa7164_dev *dev) 876 { 877 if (request_mem_region(pci_resource_start(dev->pci, 0), 878 pci_resource_len(dev->pci, 0), dev->name)) { 879 880 if (request_mem_region(pci_resource_start(dev->pci, 2), 881 pci_resource_len(dev->pci, 2), dev->name)) 882 return 0; 883 } 884 885 printk(KERN_ERR "%s: can't get MMIO memory @ 0x%llx or 0x%llx\n", 886 dev->name, 887 (u64)pci_resource_start(dev->pci, 0), 888 (u64)pci_resource_start(dev->pci, 2)); 889 890 return -EBUSY; 891 } 892 893 static int saa7164_port_init(struct saa7164_dev *dev, int portnr) 894 { 895 struct saa7164_port *port = NULL; 896 897 BUG_ON((portnr < 0) || (portnr >= SAA7164_MAX_PORTS)); 898 899 port = &dev->ports[portnr]; 900 901 port->dev = dev; 902 port->nr = portnr; 903 904 if ((portnr == SAA7164_PORT_TS1) || (portnr == SAA7164_PORT_TS2)) 905 port->type = SAA7164_MPEG_DVB; 906 else 907 if ((portnr == SAA7164_PORT_ENC1) || (portnr == SAA7164_PORT_ENC2)) { 908 port->type = SAA7164_MPEG_ENCODER; 909 910 /* We need a deferred interrupt handler for cmd handling */ 911 INIT_WORK(&port->workenc, saa7164_work_enchandler); 912 } else if ((portnr == SAA7164_PORT_VBI1) || (portnr == SAA7164_PORT_VBI2)) { 913 port->type = SAA7164_MPEG_VBI; 914 915 /* We need a deferred interrupt handler for cmd handling */ 916 INIT_WORK(&port->workenc, saa7164_work_vbihandler); 917 } else 918 BUG(); 919 920 /* Init all the critical resources */ 921 mutex_init(&port->dvb.lock); 922 INIT_LIST_HEAD(&port->dmaqueue.list); 923 mutex_init(&port->dmaqueue_lock); 924 925 INIT_LIST_HEAD(&port->list_buf_used.list); 926 INIT_LIST_HEAD(&port->list_buf_free.list); 927 init_waitqueue_head(&port->wait_read); 928 929 930 saa7164_histogram_reset(&port->irq_interval, "irq intervals"); 931 saa7164_histogram_reset(&port->svc_interval, "deferred intervals"); 932 saa7164_histogram_reset(&port->irq_svc_interval, 933 "irq to deferred intervals"); 934 saa7164_histogram_reset(&port->read_interval, 935 "encoder/vbi read() intervals"); 936 saa7164_histogram_reset(&port->poll_interval, 937 "encoder/vbi poll() intervals"); 938 939 return 0; 940 } 941 942 static int saa7164_dev_setup(struct saa7164_dev *dev) 943 { 944 int i; 945 946 mutex_init(&dev->lock); 947 atomic_inc(&dev->refcount); 948 dev->nr = saa7164_devcount++; 949 950 snprintf(dev->name, sizeof(dev->name), "saa7164[%d]", dev->nr); 951 952 mutex_lock(&devlist); 953 list_add_tail(&dev->devlist, &saa7164_devlist); 954 mutex_unlock(&devlist); 955 956 /* board config */ 957 dev->board = UNSET; 958 if (card[dev->nr] < saa7164_bcount) 959 dev->board = card[dev->nr]; 960 961 for (i = 0; UNSET == dev->board && i < saa7164_idcount; i++) 962 if (dev->pci->subsystem_vendor == saa7164_subids[i].subvendor && 963 dev->pci->subsystem_device == 964 saa7164_subids[i].subdevice) 965 dev->board = saa7164_subids[i].card; 966 967 if (UNSET == dev->board) { 968 dev->board = SAA7164_BOARD_UNKNOWN; 969 saa7164_card_list(dev); 970 } 971 972 dev->pci_bus = dev->pci->bus->number; 973 dev->pci_slot = PCI_SLOT(dev->pci->devfn); 974 975 /* I2C Defaults / setup */ 976 dev->i2c_bus[0].dev = dev; 977 dev->i2c_bus[0].nr = 0; 978 dev->i2c_bus[1].dev = dev; 979 dev->i2c_bus[1].nr = 1; 980 dev->i2c_bus[2].dev = dev; 981 dev->i2c_bus[2].nr = 2; 982 983 /* Transport + Encoder ports 1, 2, 3, 4 - Defaults / setup */ 984 saa7164_port_init(dev, SAA7164_PORT_TS1); 985 saa7164_port_init(dev, SAA7164_PORT_TS2); 986 saa7164_port_init(dev, SAA7164_PORT_ENC1); 987 saa7164_port_init(dev, SAA7164_PORT_ENC2); 988 saa7164_port_init(dev, SAA7164_PORT_VBI1); 989 saa7164_port_init(dev, SAA7164_PORT_VBI2); 990 991 if (get_resources(dev) < 0) { 992 printk(KERN_ERR "CORE %s No more PCIe resources for subsystem: %04x:%04x\n", 993 dev->name, dev->pci->subsystem_vendor, 994 dev->pci->subsystem_device); 995 996 saa7164_devcount--; 997 return -ENODEV; 998 } 999 1000 /* PCI/e allocations */ 1001 dev->lmmio = ioremap(pci_resource_start(dev->pci, 0), 1002 pci_resource_len(dev->pci, 0)); 1003 1004 dev->lmmio2 = ioremap(pci_resource_start(dev->pci, 2), 1005 pci_resource_len(dev->pci, 2)); 1006 1007 dev->bmmio = (u8 __iomem *)dev->lmmio; 1008 dev->bmmio2 = (u8 __iomem *)dev->lmmio2; 1009 1010 /* Interrupt and ack register locations offset of bmmio */ 1011 dev->int_status = 0x183000 + 0xf80; 1012 dev->int_ack = 0x183000 + 0xf90; 1013 1014 printk(KERN_INFO 1015 "CORE %s: subsystem: %04x:%04x, board: %s [card=%d,%s]\n", 1016 dev->name, dev->pci->subsystem_vendor, 1017 dev->pci->subsystem_device, saa7164_boards[dev->board].name, 1018 dev->board, card[dev->nr] == dev->board ? 1019 "insmod option" : "autodetected"); 1020 1021 saa7164_pci_quirks(dev); 1022 1023 return 0; 1024 } 1025 1026 static void saa7164_dev_unregister(struct saa7164_dev *dev) 1027 { 1028 dprintk(1, "%s()\n", __func__); 1029 1030 release_mem_region(pci_resource_start(dev->pci, 0), 1031 pci_resource_len(dev->pci, 0)); 1032 1033 release_mem_region(pci_resource_start(dev->pci, 2), 1034 pci_resource_len(dev->pci, 2)); 1035 1036 if (!atomic_dec_and_test(&dev->refcount)) 1037 return; 1038 1039 iounmap(dev->lmmio); 1040 iounmap(dev->lmmio2); 1041 1042 return; 1043 } 1044 1045 #ifdef CONFIG_DEBUG_FS 1046 static void *saa7164_seq_start(struct seq_file *s, loff_t *pos) 1047 { 1048 struct saa7164_dev *dev; 1049 loff_t index = *pos; 1050 1051 mutex_lock(&devlist); 1052 list_for_each_entry(dev, &saa7164_devlist, devlist) { 1053 if (index-- == 0) { 1054 mutex_unlock(&devlist); 1055 return dev; 1056 } 1057 } 1058 mutex_unlock(&devlist); 1059 1060 return NULL; 1061 } 1062 1063 static void *saa7164_seq_next(struct seq_file *s, void *v, loff_t *pos) 1064 { 1065 struct saa7164_dev *dev = v; 1066 void *ret; 1067 1068 mutex_lock(&devlist); 1069 if (list_is_last(&dev->devlist, &saa7164_devlist)) 1070 ret = NULL; 1071 else 1072 ret = list_next_entry(dev, devlist); 1073 mutex_unlock(&devlist); 1074 1075 ++*pos; 1076 1077 return ret; 1078 } 1079 1080 static void saa7164_seq_stop(struct seq_file *s, void *v) 1081 { 1082 } 1083 1084 static int saa7164_seq_show(struct seq_file *m, void *v) 1085 { 1086 struct saa7164_dev *dev = v; 1087 struct tmComResBusInfo *b; 1088 int i, c; 1089 1090 seq_printf(m, "%s = %p\n", dev->name, dev); 1091 1092 /* Lock the bus from any other access */ 1093 b = &dev->bus; 1094 mutex_lock(&b->lock); 1095 1096 seq_printf(m, " .m_pdwSetWritePos = 0x%x (0x%08x)\n", 1097 b->m_dwSetReadPos, saa7164_readl(b->m_dwSetReadPos)); 1098 1099 seq_printf(m, " .m_pdwSetReadPos = 0x%x (0x%08x)\n", 1100 b->m_dwSetWritePos, saa7164_readl(b->m_dwSetWritePos)); 1101 1102 seq_printf(m, " .m_pdwGetWritePos = 0x%x (0x%08x)\n", 1103 b->m_dwGetReadPos, saa7164_readl(b->m_dwGetReadPos)); 1104 1105 seq_printf(m, " .m_pdwGetReadPos = 0x%x (0x%08x)\n", 1106 b->m_dwGetWritePos, saa7164_readl(b->m_dwGetWritePos)); 1107 c = 0; 1108 seq_puts(m, "\n Set Ring:\n"); 1109 seq_puts(m, "\n addr 00 01 02 03 04 05 06 07 08 09 0a 0b 0c 0d 0e 0f\n"); 1110 for (i = 0; i < b->m_dwSizeSetRing; i++) { 1111 if (c == 0) 1112 seq_printf(m, " %04x:", i); 1113 1114 seq_printf(m, " %02x", readb(b->m_pdwSetRing + i)); 1115 1116 if (++c == 16) { 1117 seq_puts(m, "\n"); 1118 c = 0; 1119 } 1120 } 1121 1122 c = 0; 1123 seq_puts(m, "\n Get Ring:\n"); 1124 seq_puts(m, "\n addr 00 01 02 03 04 05 06 07 08 09 0a 0b 0c 0d 0e 0f\n"); 1125 for (i = 0; i < b->m_dwSizeGetRing; i++) { 1126 if (c == 0) 1127 seq_printf(m, " %04x:", i); 1128 1129 seq_printf(m, " %02x", readb(b->m_pdwGetRing + i)); 1130 1131 if (++c == 16) { 1132 seq_puts(m, "\n"); 1133 c = 0; 1134 } 1135 } 1136 1137 mutex_unlock(&b->lock); 1138 1139 return 0; 1140 } 1141 1142 static const struct seq_operations saa7164_sops = { 1143 .start = saa7164_seq_start, 1144 .next = saa7164_seq_next, 1145 .stop = saa7164_seq_stop, 1146 .show = saa7164_seq_show, 1147 }; 1148 1149 DEFINE_SEQ_ATTRIBUTE(saa7164); 1150 1151 static struct dentry *saa7614_dentry; 1152 1153 static void __init saa7164_debugfs_create(void) 1154 { 1155 saa7614_dentry = debugfs_create_file("saa7164", 0444, NULL, NULL, 1156 &saa7164_fops); 1157 } 1158 1159 static void __exit saa7164_debugfs_remove(void) 1160 { 1161 debugfs_remove(saa7614_dentry); 1162 } 1163 #else 1164 static void saa7164_debugfs_create(void) { } 1165 static void saa7164_debugfs_remove(void) { } 1166 #endif 1167 1168 static int saa7164_thread_function(void *data) 1169 { 1170 struct saa7164_dev *dev = data; 1171 struct tmFwInfoStruct fwinfo; 1172 u64 last_poll_time = 0; 1173 1174 dprintk(DBGLVL_THR, "thread started\n"); 1175 1176 set_freezable(); 1177 1178 while (1) { 1179 msleep_interruptible(100); 1180 if (kthread_should_stop()) 1181 break; 1182 try_to_freeze(); 1183 1184 dprintk(DBGLVL_THR, "thread running\n"); 1185 1186 /* Dump the firmware debug message to console */ 1187 /* Polling this costs us 1-2% of the arm CPU */ 1188 /* convert this into a respnde to interrupt 0x7a */ 1189 saa7164_api_collect_debug(dev); 1190 1191 /* Monitor CPU load every 1 second */ 1192 if ((last_poll_time + 1000 /* ms */) < jiffies_to_msecs(jiffies)) { 1193 saa7164_api_get_load_info(dev, &fwinfo); 1194 last_poll_time = jiffies_to_msecs(jiffies); 1195 } 1196 1197 } 1198 1199 dprintk(DBGLVL_THR, "thread exiting\n"); 1200 return 0; 1201 } 1202 1203 static bool saa7164_enable_msi(struct pci_dev *pci_dev, struct saa7164_dev *dev) 1204 { 1205 int err; 1206 1207 if (!enable_msi) { 1208 printk(KERN_WARNING "%s() MSI disabled by module parameter 'enable_msi'" 1209 , __func__); 1210 return false; 1211 } 1212 1213 err = pci_enable_msi(pci_dev); 1214 1215 if (err) { 1216 printk(KERN_ERR "%s() Failed to enable MSI interrupt. Falling back to a shared IRQ\n", 1217 __func__); 1218 return false; 1219 } 1220 1221 /* no error - so request an msi interrupt */ 1222 err = request_irq(pci_dev->irq, saa7164_irq, 0, 1223 dev->name, dev); 1224 1225 if (err) { 1226 /* fall back to legacy interrupt */ 1227 printk(KERN_ERR "%s() Failed to get an MSI interrupt. Falling back to a shared IRQ\n", 1228 __func__); 1229 pci_disable_msi(pci_dev); 1230 return false; 1231 } 1232 1233 return true; 1234 } 1235 1236 static int saa7164_initdev(struct pci_dev *pci_dev, 1237 const struct pci_device_id *pci_id) 1238 { 1239 struct saa7164_dev *dev; 1240 int err, i; 1241 u32 version; 1242 1243 dev = kzalloc(sizeof(*dev), GFP_KERNEL); 1244 if (NULL == dev) 1245 return -ENOMEM; 1246 1247 err = v4l2_device_register(&pci_dev->dev, &dev->v4l2_dev); 1248 if (err < 0) { 1249 dev_err(&pci_dev->dev, "v4l2_device_register failed\n"); 1250 goto fail_free; 1251 } 1252 1253 /* pci init */ 1254 dev->pci = pci_dev; 1255 if (pci_enable_device(pci_dev)) { 1256 err = -EIO; 1257 goto fail_free; 1258 } 1259 1260 if (saa7164_dev_setup(dev) < 0) { 1261 err = -EINVAL; 1262 goto fail_free; 1263 } 1264 1265 /* print pci info */ 1266 dev->pci_rev = pci_dev->revision; 1267 pci_read_config_byte(pci_dev, PCI_LATENCY_TIMER, &dev->pci_lat); 1268 printk(KERN_INFO "%s/0: found at %s, rev: %d, irq: %d, latency: %d, mmio: 0x%llx\n", 1269 dev->name, 1270 pci_name(pci_dev), dev->pci_rev, pci_dev->irq, 1271 dev->pci_lat, 1272 (unsigned long long)pci_resource_start(pci_dev, 0)); 1273 1274 pci_set_master(pci_dev); 1275 /* TODO */ 1276 err = dma_set_mask(&pci_dev->dev, 0xffffffff); 1277 if (err) { 1278 printk("%s/0: Oops: no 32bit PCI DMA ???\n", dev->name); 1279 goto fail_irq; 1280 } 1281 1282 /* irq bit */ 1283 if (saa7164_enable_msi(pci_dev, dev)) { 1284 dev->msi = true; 1285 } else { 1286 /* if we have an error (i.e. we don't have an interrupt) 1287 or msi is not enabled - fallback to shared interrupt */ 1288 1289 err = request_irq(pci_dev->irq, saa7164_irq, 1290 IRQF_SHARED, dev->name, dev); 1291 1292 if (err < 0) { 1293 printk(KERN_ERR "%s: can't get IRQ %d\n", dev->name, 1294 pci_dev->irq); 1295 err = -EIO; 1296 goto fail_irq; 1297 } 1298 } 1299 1300 pci_set_drvdata(pci_dev, dev); 1301 1302 /* Init the internal command list */ 1303 for (i = 0; i < SAA_CMD_MAX_MSG_UNITS; i++) { 1304 dev->cmds[i].seqno = i; 1305 dev->cmds[i].inuse = 0; 1306 mutex_init(&dev->cmds[i].lock); 1307 init_waitqueue_head(&dev->cmds[i].wait); 1308 } 1309 1310 /* We need a deferred interrupt handler for cmd handling */ 1311 INIT_WORK(&dev->workcmd, saa7164_work_cmdhandler); 1312 1313 /* Only load the firmware if we know the board */ 1314 if (dev->board != SAA7164_BOARD_UNKNOWN) { 1315 1316 err = saa7164_downloadfirmware(dev); 1317 if (err < 0) { 1318 printk(KERN_ERR 1319 "Failed to boot firmware, no features registered\n"); 1320 goto fail_fw; 1321 } 1322 1323 saa7164_get_descriptors(dev); 1324 saa7164_dumpregs(dev, 0); 1325 saa7164_getcurrentfirmwareversion(dev); 1326 saa7164_getfirmwarestatus(dev); 1327 err = saa7164_bus_setup(dev); 1328 if (err < 0) 1329 printk(KERN_ERR 1330 "Failed to setup the bus, will continue\n"); 1331 saa7164_bus_dump(dev); 1332 1333 /* Ping the running firmware via the command bus and get the 1334 * firmware version, this checks the bus is running OK. 1335 */ 1336 version = 0; 1337 if (saa7164_api_get_fw_version(dev, &version) == SAA_OK) 1338 dprintk(1, "Bus is operating correctly using version %d.%d.%d.%d (0x%x)\n", 1339 (version & 0x0000fc00) >> 10, 1340 (version & 0x000003e0) >> 5, 1341 (version & 0x0000001f), 1342 (version & 0xffff0000) >> 16, 1343 version); 1344 else 1345 printk(KERN_ERR 1346 "Failed to communicate with the firmware\n"); 1347 1348 /* Bring up the I2C buses */ 1349 saa7164_i2c_register(&dev->i2c_bus[0]); 1350 saa7164_i2c_register(&dev->i2c_bus[1]); 1351 saa7164_i2c_register(&dev->i2c_bus[2]); 1352 saa7164_gpio_setup(dev); 1353 saa7164_card_setup(dev); 1354 1355 /* Parse the dynamic device configuration, find various 1356 * media endpoints (MPEG, WMV, PS, TS) and cache their 1357 * configuration details into the driver, so we can 1358 * reference them later during simething_register() func, 1359 * interrupt handlers, deferred work handlers etc. 1360 */ 1361 saa7164_api_enum_subdevs(dev); 1362 1363 /* Begin to create the video sub-systems and register funcs */ 1364 if (saa7164_boards[dev->board].porta == SAA7164_MPEG_DVB) { 1365 if (saa7164_dvb_register(&dev->ports[SAA7164_PORT_TS1]) < 0) { 1366 printk(KERN_ERR "%s() Failed to register dvb adapters on porta\n", 1367 __func__); 1368 } 1369 } 1370 1371 if (saa7164_boards[dev->board].portb == SAA7164_MPEG_DVB) { 1372 if (saa7164_dvb_register(&dev->ports[SAA7164_PORT_TS2]) < 0) { 1373 printk(KERN_ERR"%s() Failed to register dvb adapters on portb\n", 1374 __func__); 1375 } 1376 } 1377 1378 if (saa7164_boards[dev->board].portc == SAA7164_MPEG_ENCODER) { 1379 if (saa7164_encoder_register(&dev->ports[SAA7164_PORT_ENC1]) < 0) { 1380 printk(KERN_ERR"%s() Failed to register mpeg encoder\n", 1381 __func__); 1382 } 1383 } 1384 1385 if (saa7164_boards[dev->board].portd == SAA7164_MPEG_ENCODER) { 1386 if (saa7164_encoder_register(&dev->ports[SAA7164_PORT_ENC2]) < 0) { 1387 printk(KERN_ERR"%s() Failed to register mpeg encoder\n", 1388 __func__); 1389 } 1390 } 1391 1392 if (saa7164_boards[dev->board].porte == SAA7164_MPEG_VBI) { 1393 if (saa7164_vbi_register(&dev->ports[SAA7164_PORT_VBI1]) < 0) { 1394 printk(KERN_ERR"%s() Failed to register vbi device\n", 1395 __func__); 1396 } 1397 } 1398 1399 if (saa7164_boards[dev->board].portf == SAA7164_MPEG_VBI) { 1400 if (saa7164_vbi_register(&dev->ports[SAA7164_PORT_VBI2]) < 0) { 1401 printk(KERN_ERR"%s() Failed to register vbi device\n", 1402 __func__); 1403 } 1404 } 1405 saa7164_api_set_debug(dev, fw_debug); 1406 1407 if (fw_debug) { 1408 dev->kthread = kthread_run(saa7164_thread_function, dev, 1409 "saa7164 debug"); 1410 if (IS_ERR(dev->kthread)) { 1411 dev->kthread = NULL; 1412 printk(KERN_ERR "%s() Failed to create debug kernel thread\n", 1413 __func__); 1414 } 1415 } 1416 1417 } /* != BOARD_UNKNOWN */ 1418 else 1419 printk(KERN_ERR "%s() Unsupported board detected, registering without firmware\n", 1420 __func__); 1421 1422 dprintk(1, "%s() parameter debug = %d\n", __func__, saa_debug); 1423 dprintk(1, "%s() parameter waitsecs = %d\n", __func__, waitsecs); 1424 1425 fail_fw: 1426 return 0; 1427 1428 fail_irq: 1429 saa7164_dev_unregister(dev); 1430 fail_free: 1431 v4l2_device_unregister(&dev->v4l2_dev); 1432 kfree(dev); 1433 return err; 1434 } 1435 1436 static void saa7164_shutdown(struct saa7164_dev *dev) 1437 { 1438 dprintk(1, "%s()\n", __func__); 1439 } 1440 1441 static void saa7164_finidev(struct pci_dev *pci_dev) 1442 { 1443 struct saa7164_dev *dev = pci_get_drvdata(pci_dev); 1444 1445 if (dev->board != SAA7164_BOARD_UNKNOWN) { 1446 if (fw_debug && dev->kthread) { 1447 kthread_stop(dev->kthread); 1448 dev->kthread = NULL; 1449 } 1450 if (dev->firmwareloaded) 1451 saa7164_api_set_debug(dev, 0x00); 1452 } 1453 1454 saa7164_histogram_print(&dev->ports[SAA7164_PORT_ENC1], 1455 &dev->ports[SAA7164_PORT_ENC1].irq_interval); 1456 saa7164_histogram_print(&dev->ports[SAA7164_PORT_ENC1], 1457 &dev->ports[SAA7164_PORT_ENC1].svc_interval); 1458 saa7164_histogram_print(&dev->ports[SAA7164_PORT_ENC1], 1459 &dev->ports[SAA7164_PORT_ENC1].irq_svc_interval); 1460 saa7164_histogram_print(&dev->ports[SAA7164_PORT_ENC1], 1461 &dev->ports[SAA7164_PORT_ENC1].read_interval); 1462 saa7164_histogram_print(&dev->ports[SAA7164_PORT_ENC1], 1463 &dev->ports[SAA7164_PORT_ENC1].poll_interval); 1464 saa7164_histogram_print(&dev->ports[SAA7164_PORT_VBI1], 1465 &dev->ports[SAA7164_PORT_VBI1].read_interval); 1466 saa7164_histogram_print(&dev->ports[SAA7164_PORT_VBI2], 1467 &dev->ports[SAA7164_PORT_VBI2].poll_interval); 1468 1469 saa7164_shutdown(dev); 1470 1471 if (saa7164_boards[dev->board].porta == SAA7164_MPEG_DVB) 1472 saa7164_dvb_unregister(&dev->ports[SAA7164_PORT_TS1]); 1473 1474 if (saa7164_boards[dev->board].portb == SAA7164_MPEG_DVB) 1475 saa7164_dvb_unregister(&dev->ports[SAA7164_PORT_TS2]); 1476 1477 if (saa7164_boards[dev->board].portc == SAA7164_MPEG_ENCODER) 1478 saa7164_encoder_unregister(&dev->ports[SAA7164_PORT_ENC1]); 1479 1480 if (saa7164_boards[dev->board].portd == SAA7164_MPEG_ENCODER) 1481 saa7164_encoder_unregister(&dev->ports[SAA7164_PORT_ENC2]); 1482 1483 if (saa7164_boards[dev->board].porte == SAA7164_MPEG_VBI) 1484 saa7164_vbi_unregister(&dev->ports[SAA7164_PORT_VBI1]); 1485 1486 if (saa7164_boards[dev->board].portf == SAA7164_MPEG_VBI) 1487 saa7164_vbi_unregister(&dev->ports[SAA7164_PORT_VBI2]); 1488 1489 saa7164_i2c_unregister(&dev->i2c_bus[0]); 1490 saa7164_i2c_unregister(&dev->i2c_bus[1]); 1491 saa7164_i2c_unregister(&dev->i2c_bus[2]); 1492 1493 /* unregister stuff */ 1494 free_irq(pci_dev->irq, dev); 1495 1496 if (dev->msi) { 1497 pci_disable_msi(pci_dev); 1498 dev->msi = false; 1499 } 1500 1501 pci_disable_device(pci_dev); 1502 1503 mutex_lock(&devlist); 1504 list_del(&dev->devlist); 1505 mutex_unlock(&devlist); 1506 1507 saa7164_dev_unregister(dev); 1508 v4l2_device_unregister(&dev->v4l2_dev); 1509 kfree(dev); 1510 } 1511 1512 static const struct pci_device_id saa7164_pci_tbl[] = { 1513 { 1514 /* SAA7164 */ 1515 .vendor = 0x1131, 1516 .device = 0x7164, 1517 .subvendor = PCI_ANY_ID, 1518 .subdevice = PCI_ANY_ID, 1519 }, { 1520 /* --- end of list --- */ 1521 } 1522 }; 1523 MODULE_DEVICE_TABLE(pci, saa7164_pci_tbl); 1524 1525 static struct pci_driver saa7164_pci_driver = { 1526 .name = "saa7164", 1527 .id_table = saa7164_pci_tbl, 1528 .probe = saa7164_initdev, 1529 .remove = saa7164_finidev, 1530 }; 1531 1532 static int __init saa7164_init(void) 1533 { 1534 int ret = pci_register_driver(&saa7164_pci_driver); 1535 1536 if (ret) 1537 return ret; 1538 1539 saa7164_debugfs_create(); 1540 1541 pr_info("saa7164 driver loaded\n"); 1542 1543 return 0; 1544 } 1545 1546 static void __exit saa7164_fini(void) 1547 { 1548 saa7164_debugfs_remove(); 1549 pci_unregister_driver(&saa7164_pci_driver); 1550 } 1551 1552 module_init(saa7164_init); 1553 module_exit(saa7164_fini); 1554