linux/drivers/ieee1394/dv1394.c
<<
>>
Prefs
   1/*
   2 * dv1394.c - DV input/output over IEEE 1394 on OHCI chips
   3 *   Copyright (C)2001 Daniel Maas <dmaas@dcine.com>
   4 *     receive by Dan Dennedy <dan@dennedy.org>
   5 *
   6 * based on:
   7 *  video1394.c - video driver for OHCI 1394 boards
   8 *  Copyright (C)1999,2000 Sebastien Rougeaux <sebastien.rougeaux@anu.edu.au>
   9 *
  10 * This program is free software; you can redistribute it and/or modify
  11 * it under the terms of the GNU General Public License as published by
  12 * the Free Software Foundation; either version 2 of the License, or
  13 * (at your option) any later version.
  14 *
  15 * This program is distributed in the hope that it will be useful,
  16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18 * GNU General Public License for more details.
  19 *
  20 * You should have received a copy of the GNU General Public License
  21 * along with this program; if not, write to the Free Software Foundation,
  22 * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  23 */
  24
  25/*
  26  OVERVIEW
  27
  28  I designed dv1394 as a "pipe" that you can use to shoot DV onto a
  29  FireWire bus. In transmission mode, dv1394 does the following:
  30
  31   1. accepts contiguous frames of DV data from user-space, via write()
  32      or mmap() (see dv1394.h for the complete API)
  33   2. wraps IEC 61883 packets around the DV data, inserting
  34      empty synchronization packets as necessary
  35   3. assigns accurate SYT timestamps to the outgoing packets
  36   4. shoots them out using the OHCI card's IT DMA engine
  37
  38   Thanks to Dan Dennedy, we now have a receive mode that does the following:
  39
  40   1. accepts raw IEC 61883 packets from the OHCI card
  41   2. re-assembles the DV data payloads into contiguous frames,
  42      discarding empty packets
  43   3. sends the DV data to user-space via read() or mmap()
  44*/
  45
  46/*
  47  TODO:
  48
  49  - tunable frame-drop behavior: either loop last frame, or halt transmission
  50
  51  - use a scatter/gather buffer for DMA programs (f->descriptor_pool)
  52    so that we don't rely on allocating 64KB of contiguous kernel memory
  53    via pci_alloc_consistent()
  54
  55  DONE:
  56  - during reception, better handling of dropped frames and continuity errors
  57  - during reception, prevent DMA from bypassing the irq tasklets
  58  - reduce irq rate during reception (1/250 packets).
  59  - add many more internal buffers during reception with scatter/gather dma.
  60  - add dbc (continuity) checking on receive, increment status.dropped_frames
  61    if not continuous.
  62  - restart IT DMA after a bus reset
  63  - safely obtain and release ISO Tx channels in cooperation with OHCI driver
  64  - map received DIF blocks to their proper location in DV frame (ensure
  65    recovery if dropped packet)
  66  - handle bus resets gracefully (OHCI card seems to take care of this itself(!))
  67  - do not allow resizing the user_buf once allocated; eliminate nuke_buffer_mappings
  68  - eliminated #ifdef DV1394_DEBUG_LEVEL by inventing macros debug_printk and irq_printk
  69  - added wmb() and mb() to places where PCI read/write ordering needs to be enforced
  70  - set video->id correctly
  71  - store video_cards in an array indexed by OHCI card ID, rather than a list
  72  - implement DMA context allocation to cooperate with other users of the OHCI
  73  - fix all XXX showstoppers
  74  - disable IR/IT DMA interrupts on shutdown
  75  - flush pci writes to the card by issuing a read
  76  - character device dispatching
  77  - switch over to the new kernel DMA API (pci_map_*()) (* needs testing on platforms with IOMMU!)
  78  - keep all video_cards in a list (for open() via chardev), set file->private_data = video
  79  - dv1394_poll should indicate POLLIN when receiving buffers are available
  80  - add proc fs interface to set cip_n, cip_d, syt_offset, and video signal
  81  - expose xmit and recv as separate devices (not exclusive)
  82  - expose NTSC and PAL as separate devices (can be overridden)
  83
  84*/
  85
  86#include <linux/kernel.h>
  87#include <linux/list.h>
  88#include <linux/slab.h>
  89#include <linux/interrupt.h>
  90#include <linux/wait.h>
  91#include <linux/errno.h>
  92#include <linux/module.h>
  93#include <linux/init.h>
  94#include <linux/pci.h>
  95#include <linux/fs.h>
  96#include <linux/poll.h>
  97#include <linux/mutex.h>
  98#include <linux/bitops.h>
  99#include <asm/byteorder.h>
 100#include <asm/atomic.h>
 101#include <asm/io.h>
 102#include <asm/uaccess.h>
 103#include <linux/delay.h>
 104#include <asm/pgtable.h>
 105#include <asm/page.h>
 106#include <linux/sched.h>
 107#include <linux/types.h>
 108#include <linux/vmalloc.h>
 109#include <linux/string.h>
 110#include <linux/compat.h>
 111#include <linux/cdev.h>
 112
 113#include "dv1394.h"
 114#include "dv1394-private.h"
 115#include "highlevel.h"
 116#include "hosts.h"
 117#include "ieee1394.h"
 118#include "ieee1394_core.h"
 119#include "ieee1394_hotplug.h"
 120#include "ieee1394_types.h"
 121#include "nodemgr.h"
 122#include "ohci1394.h"
 123
 124/* DEBUG LEVELS:
 125   0 - no debugging messages
 126   1 - some debugging messages, but none during DMA frame transmission
 127   2 - lots of messages, including during DMA frame transmission
 128       (will cause undeflows if your machine is too slow!)
 129*/
 130
 131#define DV1394_DEBUG_LEVEL 0
 132
 133/* for debugging use ONLY: allow more than one open() of the device */
 134/* #define DV1394_ALLOW_MORE_THAN_ONE_OPEN 1 */
 135
 136#if DV1394_DEBUG_LEVEL >= 2
 137#define irq_printk( args... ) printk( args )
 138#else
 139#define irq_printk( args... ) do {} while (0)
 140#endif
 141
 142#if DV1394_DEBUG_LEVEL >= 1
 143#define debug_printk( args... ) printk( args)
 144#else
 145#define debug_printk( args... ) do {} while (0)
 146#endif
 147
 148/* issue a dummy PCI read to force the preceding write
 149   to be posted to the PCI bus immediately */
 150
 151static inline void flush_pci_write(struct ti_ohci *ohci)
 152{
 153        mb();
 154        reg_read(ohci, OHCI1394_IsochronousCycleTimer);
 155}
 156
 157static void it_tasklet_func(unsigned long data);
 158static void ir_tasklet_func(unsigned long data);
 159
 160#ifdef CONFIG_COMPAT
 161static long dv1394_compat_ioctl(struct file *file, unsigned int cmd,
 162                               unsigned long arg);
 163#endif
 164
 165/* GLOBAL DATA */
 166
 167/* list of all video_cards */
 168static LIST_HEAD(dv1394_cards);
 169static DEFINE_SPINLOCK(dv1394_cards_lock);
 170
 171/* translate from a struct file* to the corresponding struct video_card* */
 172
 173static inline struct video_card* file_to_video_card(struct file *file)
 174{
 175        return (struct video_card*) file->private_data;
 176}
 177
 178/*** FRAME METHODS *********************************************************/
 179
 180static void frame_reset(struct frame *f)
 181{
 182        f->state = FRAME_CLEAR;
 183        f->done = 0;
 184        f->n_packets = 0;
 185        f->frame_begin_timestamp = NULL;
 186        f->assigned_timestamp = 0;
 187        f->cip_syt1 = NULL;
 188        f->cip_syt2 = NULL;
 189        f->mid_frame_timestamp = NULL;
 190        f->frame_end_timestamp = NULL;
 191        f->frame_end_branch = NULL;
 192}
 193
 194static struct frame* frame_new(unsigned int frame_num, struct video_card *video)
 195{
 196        struct frame *f = kmalloc(sizeof(*f), GFP_KERNEL);
 197        if (!f)
 198                return NULL;
 199
 200        f->video = video;
 201        f->frame_num = frame_num;
 202
 203        f->header_pool = pci_alloc_consistent(f->video->ohci->dev, PAGE_SIZE, &f->header_pool_dma);
 204        if (!f->header_pool) {
 205                printk(KERN_ERR "dv1394: failed to allocate CIP header pool\n");
 206                kfree(f);
 207                return NULL;
 208        }
 209
 210        debug_printk("dv1394: frame_new: allocated CIP header pool at virt 0x%08lx (contig) dma 0x%08lx size %ld\n",
 211                     (unsigned long) f->header_pool, (unsigned long) f->header_pool_dma, PAGE_SIZE);
 212
 213        f->descriptor_pool_size = MAX_PACKETS * sizeof(struct DMA_descriptor_block);
 214        /* make it an even # of pages */
 215        f->descriptor_pool_size += PAGE_SIZE - (f->descriptor_pool_size%PAGE_SIZE);
 216
 217        f->descriptor_pool = pci_alloc_consistent(f->video->ohci->dev,
 218                                                  f->descriptor_pool_size,
 219                                                  &f->descriptor_pool_dma);
 220        if (!f->descriptor_pool) {
 221                pci_free_consistent(f->video->ohci->dev, PAGE_SIZE, f->header_pool, f->header_pool_dma);
 222                kfree(f);
 223                return NULL;
 224        }
 225
 226        debug_printk("dv1394: frame_new: allocated DMA program memory at virt 0x%08lx (contig) dma 0x%08lx size %ld\n",
 227                     (unsigned long) f->descriptor_pool, (unsigned long) f->descriptor_pool_dma, f->descriptor_pool_size);
 228
 229        f->data = 0;
 230        frame_reset(f);
 231
 232        return f;
 233}
 234
 235static void frame_delete(struct frame *f)
 236{
 237        pci_free_consistent(f->video->ohci->dev, PAGE_SIZE, f->header_pool, f->header_pool_dma);
 238        pci_free_consistent(f->video->ohci->dev, f->descriptor_pool_size, f->descriptor_pool, f->descriptor_pool_dma);
 239        kfree(f);
 240}
 241
 242
 243
 244
 245/*
 246   frame_prepare() - build the DMA program for transmitting
 247
 248   Frame_prepare() must be called OUTSIDE the video->spinlock.
 249   However, frame_prepare() must still be serialized, so
 250   it should be called WITH the video->mtx taken.
 251 */
 252
 253static void frame_prepare(struct video_card *video, unsigned int this_frame)
 254{
 255        struct frame *f = video->frames[this_frame];
 256        int last_frame;
 257
 258        struct DMA_descriptor_block *block;
 259        dma_addr_t block_dma;
 260        struct CIP_header *cip;
 261        dma_addr_t cip_dma;
 262
 263        unsigned int n_descriptors, full_packets, packets_per_frame, payload_size;
 264
 265        /* these flags denote packets that need special attention */
 266        int empty_packet, first_packet, last_packet, mid_packet;
 267
 268        __le32 *branch_address, *last_branch_address = NULL;
 269        unsigned long data_p;
 270        int first_packet_empty = 0;
 271        u32 cycleTimer, ct_sec, ct_cyc, ct_off;
 272        unsigned long irq_flags;
 273
 274        irq_printk("frame_prepare( %d ) ---------------------\n", this_frame);
 275
 276        full_packets = 0;
 277
 278
 279
 280        if (video->pal_or_ntsc == DV1394_PAL)
 281                packets_per_frame = DV1394_PAL_PACKETS_PER_FRAME;
 282        else
 283                packets_per_frame = DV1394_NTSC_PACKETS_PER_FRAME;
 284
 285        while ( full_packets < packets_per_frame ) {
 286                empty_packet = first_packet = last_packet = mid_packet = 0;
 287
 288                data_p = f->data + full_packets * 480;
 289
 290                /************************************************/
 291                /* allocate a descriptor block and a CIP header */
 292                /************************************************/
 293
 294                /* note: these should NOT cross a page boundary (DMA restriction) */
 295
 296                if (f->n_packets >= MAX_PACKETS) {
 297                        printk(KERN_ERR "dv1394: FATAL ERROR: max packet count exceeded\n");
 298                        return;
 299                }
 300
 301                /* the block surely won't cross a page boundary,
 302                   since an even number of descriptor_blocks fit on a page */
 303                block = &(f->descriptor_pool[f->n_packets]);
 304
 305                /* DMA address of the block = offset of block relative
 306                    to the kernel base address of the descriptor pool
 307                    + DMA base address of the descriptor pool */
 308                block_dma = ((unsigned long) block - (unsigned long) f->descriptor_pool) + f->descriptor_pool_dma;
 309
 310
 311                /* the whole CIP pool fits on one page, so no worries about boundaries */
 312                if ( ((unsigned long) &(f->header_pool[f->n_packets]) - (unsigned long) f->header_pool)
 313                    > PAGE_SIZE) {
 314                        printk(KERN_ERR "dv1394: FATAL ERROR: no room to allocate CIP header\n");
 315                        return;
 316                }
 317
 318                cip = &(f->header_pool[f->n_packets]);
 319
 320                /* DMA address of the CIP header = offset of cip
 321                   relative to kernel base address of the header pool
 322                   + DMA base address of the header pool */
 323                cip_dma = (unsigned long) cip % PAGE_SIZE + f->header_pool_dma;
 324
 325                /* is this an empty packet? */
 326
 327                if (video->cip_accum > (video->cip_d - video->cip_n)) {
 328                        empty_packet = 1;
 329                        payload_size = 8;
 330                        video->cip_accum -= (video->cip_d - video->cip_n);
 331                } else {
 332                        payload_size = 488;
 333                        video->cip_accum += video->cip_n;
 334                }
 335
 336                /* there are three important packets each frame:
 337
 338                   the first packet in the frame - we ask the card to record the timestamp when
 339                                                   this packet is actually sent, so we can monitor
 340                                                   how accurate our timestamps are. Also, the first
 341                                                   packet serves as a semaphore to let us know that
 342                                                   it's OK to free the *previous* frame's DMA buffer
 343
 344                   the last packet in the frame -  this packet is used to detect buffer underflows.
 345                                                   if this is the last ready frame, the last DMA block
 346                                                   will have a branch back to the beginning of the frame
 347                                                   (so that the card will re-send the frame on underflow).
 348                                                   if this branch gets taken, we know that at least one
 349                                                   frame has been dropped. When the next frame is ready,
 350                                                   the branch is pointed to its first packet, and the
 351                                                   semaphore is disabled.
 352
 353                   a "mid" packet slightly before the end of the frame - this packet should trigger
 354                                   an interrupt so we can go and assign a timestamp to the first packet
 355                                   in the next frame. We don't use the very last packet in the frame
 356                                   for this purpose, because that would leave very little time to set
 357                                   the timestamp before DMA starts on the next frame.
 358                */
 359
 360                if (f->n_packets == 0) {
 361                        first_packet = 1;
 362                } else if ( full_packets == (packets_per_frame-1) ) {
 363                        last_packet = 1;
 364                } else if (f->n_packets == packets_per_frame) {
 365                        mid_packet = 1;
 366                }
 367
 368
 369                /********************/
 370                /* setup CIP header */
 371                /********************/
 372
 373                /* the timestamp will be written later from the
 374                   mid-frame interrupt handler. For now we just
 375                   store the address of the CIP header(s) that
 376                   need a timestamp. */
 377
 378                /* first packet in the frame needs a timestamp */
 379                if (first_packet) {
 380                        f->cip_syt1 = cip;
 381                        if (empty_packet)
 382                                first_packet_empty = 1;
 383
 384                } else if (first_packet_empty && (f->n_packets == 1) ) {
 385                        /* if the first packet was empty, the second
 386                           packet's CIP header also needs a timestamp */
 387                        f->cip_syt2 = cip;
 388                }
 389
 390                fill_cip_header(cip,
 391                                /* the node ID number of the OHCI card */
 392                                reg_read(video->ohci, OHCI1394_NodeID) & 0x3F,
 393                                video->continuity_counter,
 394                                video->pal_or_ntsc,
 395                                0xFFFF /* the timestamp is filled in later */);
 396
 397                /* advance counter, only for full packets */
 398                if ( ! empty_packet )
 399                        video->continuity_counter++;
 400
 401                /******************************/
 402                /* setup DMA descriptor block */
 403                /******************************/
 404
 405                /* first descriptor - OUTPUT_MORE_IMMEDIATE, for the controller's IT header */
 406                fill_output_more_immediate( &(block->u.out.omi), 1, video->channel, 0, payload_size);
 407
 408                if (empty_packet) {
 409                        /* second descriptor - OUTPUT_LAST for CIP header */
 410                        fill_output_last( &(block->u.out.u.empty.ol),
 411
 412                                          /* want completion status on all interesting packets */
 413                                          (first_packet || mid_packet || last_packet) ? 1 : 0,
 414
 415                                          /* want interrupts on all interesting packets */
 416                                          (first_packet || mid_packet || last_packet) ? 1 : 0,
 417
 418                                          sizeof(struct CIP_header), /* data size */
 419                                          cip_dma);
 420
 421                        if (first_packet)
 422                                f->frame_begin_timestamp = &(block->u.out.u.empty.ol.q[3]);
 423                        else if (mid_packet)
 424                                f->mid_frame_timestamp = &(block->u.out.u.empty.ol.q[3]);
 425                        else if (last_packet) {
 426                                f->frame_end_timestamp = &(block->u.out.u.empty.ol.q[3]);
 427                                f->frame_end_branch = &(block->u.out.u.empty.ol.q[2]);
 428                        }
 429
 430                        branch_address = &(block->u.out.u.empty.ol.q[2]);
 431                        n_descriptors = 3;
 432                        if (first_packet)
 433                                f->first_n_descriptors = n_descriptors;
 434
 435                } else { /* full packet */
 436
 437                        /* second descriptor - OUTPUT_MORE for CIP header */
 438                        fill_output_more( &(block->u.out.u.full.om),
 439                                          sizeof(struct CIP_header), /* data size */
 440                                          cip_dma);
 441
 442
 443                        /* third (and possibly fourth) descriptor - for DV data */
 444                        /* the 480-byte payload can cross a page boundary; if so,
 445                           we need to split it into two DMA descriptors */
 446
 447                        /* does the 480-byte data payload cross a page boundary? */
 448                        if ( (PAGE_SIZE- ((unsigned long)data_p % PAGE_SIZE) ) < 480 ) {
 449
 450                                /* page boundary crossed */
 451
 452                                fill_output_more( &(block->u.out.u.full.u.cross.om),
 453                                                  /* data size - how much of data_p fits on the first page */
 454                                                  PAGE_SIZE - (data_p % PAGE_SIZE),
 455
 456                                                  /* DMA address of data_p */
 457                                                  dma_region_offset_to_bus(&video->dv_buf,
 458                                                                           data_p - (unsigned long) video->dv_buf.kvirt));
 459
 460                                fill_output_last( &(block->u.out.u.full.u.cross.ol),
 461
 462                                                  /* want completion status on all interesting packets */
 463                                                  (first_packet || mid_packet || last_packet) ? 1 : 0,
 464
 465                                                  /* want interrupt on all interesting packets */
 466                                                  (first_packet || mid_packet || last_packet) ? 1 : 0,
 467
 468                                                  /* data size - remaining portion of data_p */
 469                                                  480 - (PAGE_SIZE - (data_p % PAGE_SIZE)),
 470
 471                                                  /* DMA address of data_p + PAGE_SIZE - (data_p % PAGE_SIZE) */
 472                                                  dma_region_offset_to_bus(&video->dv_buf,
 473                                                                           data_p + PAGE_SIZE - (data_p % PAGE_SIZE) - (unsigned long) video->dv_buf.kvirt));
 474
 475                                if (first_packet)
 476                                        f->frame_begin_timestamp = &(block->u.out.u.full.u.cross.ol.q[3]);
 477                                else if (mid_packet)
 478                                        f->mid_frame_timestamp = &(block->u.out.u.full.u.cross.ol.q[3]);
 479                                else if (last_packet) {
 480                                        f->frame_end_timestamp = &(block->u.out.u.full.u.cross.ol.q[3]);
 481                                        f->frame_end_branch = &(block->u.out.u.full.u.cross.ol.q[2]);
 482                                }
 483
 484                                branch_address = &(block->u.out.u.full.u.cross.ol.q[2]);
 485
 486                                n_descriptors = 5;
 487                                if (first_packet)
 488                                        f->first_n_descriptors = n_descriptors;
 489
 490                                full_packets++;
 491
 492                        } else {
 493                                /* fits on one page */
 494
 495                                fill_output_last( &(block->u.out.u.full.u.nocross.ol),
 496
 497                                                  /* want completion status on all interesting packets */
 498                                                  (first_packet || mid_packet || last_packet) ? 1 : 0,
 499
 500                                                  /* want interrupt on all interesting packets */
 501                                                  (first_packet || mid_packet || last_packet) ? 1 : 0,
 502
 503                                                  480, /* data size (480 bytes of DV data) */
 504
 505
 506                                                  /* DMA address of data_p */
 507                                                  dma_region_offset_to_bus(&video->dv_buf,
 508                                                                           data_p - (unsigned long) video->dv_buf.kvirt));
 509
 510                                if (first_packet)
 511                                        f->frame_begin_timestamp = &(block->u.out.u.full.u.nocross.ol.q[3]);
 512                                else if (mid_packet)
 513                                        f->mid_frame_timestamp = &(block->u.out.u.full.u.nocross.ol.q[3]);
 514                                else if (last_packet) {
 515                                        f->frame_end_timestamp = &(block->u.out.u.full.u.nocross.ol.q[3]);
 516                                        f->frame_end_branch = &(block->u.out.u.full.u.nocross.ol.q[2]);
 517                                }
 518
 519                                branch_address = &(block->u.out.u.full.u.nocross.ol.q[2]);
 520
 521                                n_descriptors = 4;
 522                                if (first_packet)
 523                                        f->first_n_descriptors = n_descriptors;
 524
 525                                full_packets++;
 526                        }
 527                }
 528
 529                /* link this descriptor block into the DMA program by filling in
 530                   the branch address of the previous block */
 531
 532                /* note: we are not linked into the active DMA chain yet */
 533
 534                if (last_branch_address) {
 535                        *(last_branch_address) = cpu_to_le32(block_dma | n_descriptors);
 536                }
 537
 538                last_branch_address = branch_address;
 539
 540
 541                f->n_packets++;
 542
 543        }
 544
 545        /* when we first assemble a new frame, set the final branch
 546           to loop back up to the top */
 547        *(f->frame_end_branch) = cpu_to_le32(f->descriptor_pool_dma | f->first_n_descriptors);
 548
 549        /* make the latest version of this frame visible to the PCI card */
 550        dma_region_sync_for_device(&video->dv_buf, f->data - (unsigned long) video->dv_buf.kvirt, video->frame_size);
 551
 552        /* lock against DMA interrupt */
 553        spin_lock_irqsave(&video->spinlock, irq_flags);
 554
 555        f->state = FRAME_READY;
 556
 557        video->n_clear_frames--;
 558
 559        last_frame = video->first_clear_frame - 1;
 560        if (last_frame == -1)
 561                last_frame = video->n_frames-1;
 562
 563        video->first_clear_frame = (video->first_clear_frame + 1) % video->n_frames;
 564
 565        irq_printk("   frame %d prepared, active_frame = %d, n_clear_frames = %d, first_clear_frame = %d\n last=%d\n",
 566                   this_frame, video->active_frame, video->n_clear_frames, video->first_clear_frame, last_frame);
 567
 568        irq_printk("   begin_ts %08lx mid_ts %08lx end_ts %08lx end_br %08lx\n",
 569                   (unsigned long) f->frame_begin_timestamp,
 570                   (unsigned long) f->mid_frame_timestamp,
 571                   (unsigned long) f->frame_end_timestamp,
 572                   (unsigned long) f->frame_end_branch);
 573
 574        if (video->active_frame != -1) {
 575
 576                /* if DMA is already active, we are almost done */
 577                /* just link us onto the active DMA chain */
 578                if (video->frames[last_frame]->frame_end_branch) {
 579                        u32 temp;
 580
 581                        /* point the previous frame's tail to this frame's head */
 582                        *(video->frames[last_frame]->frame_end_branch) = cpu_to_le32(f->descriptor_pool_dma | f->first_n_descriptors);
 583
 584                        /* this write MUST precede the next one, or we could silently drop frames */
 585                        wmb();
 586
 587                        /* disable the want_status semaphore on the last packet */
 588                        temp = le32_to_cpu(*(video->frames[last_frame]->frame_end_branch - 2));
 589                        temp &= 0xF7CFFFFF;
 590                        *(video->frames[last_frame]->frame_end_branch - 2) = cpu_to_le32(temp);
 591
 592                        /* flush these writes to memory ASAP */
 593                        flush_pci_write(video->ohci);
 594
 595                        /* NOTE:
 596                           ideally the writes should be "atomic": if
 597                           the OHCI card reads the want_status flag in
 598                           between them, we'll falsely report a
 599                           dropped frame. Hopefully this window is too
 600                           small to really matter, and the consequence
 601                           is rather harmless. */
 602
 603
 604                        irq_printk("     new frame %d linked onto DMA chain\n", this_frame);
 605
 606                } else {
 607                        printk(KERN_ERR "dv1394: last frame not ready???\n");
 608                }
 609
 610        } else {
 611
 612                u32 transmit_sec, transmit_cyc;
 613                u32 ts_cyc, ts_off;
 614
 615                /* DMA is stopped, so this is the very first frame */
 616                video->active_frame = this_frame;
 617
 618                /* set CommandPtr to address and size of first descriptor block */
 619                reg_write(video->ohci, video->ohci_IsoXmitCommandPtr,
 620                          video->frames[video->active_frame]->descriptor_pool_dma |
 621                          f->first_n_descriptors);
 622
 623                /* assign a timestamp based on the current cycle time...
 624                   We'll tell the card to begin DMA 100 cycles from now,
 625                   and assign a timestamp 103 cycles from now */
 626
 627                cycleTimer = reg_read(video->ohci, OHCI1394_IsochronousCycleTimer);
 628
 629                ct_sec = cycleTimer >> 25;
 630                ct_cyc = (cycleTimer >> 12) & 0x1FFF;
 631                ct_off = cycleTimer & 0xFFF;
 632
 633                transmit_sec = ct_sec;
 634                transmit_cyc = ct_cyc + 100;
 635
 636                transmit_sec += transmit_cyc/8000;
 637                transmit_cyc %= 8000;
 638
 639                ts_off = ct_off;
 640                ts_cyc = transmit_cyc + 3;
 641                ts_cyc %= 8000;
 642
 643                f->assigned_timestamp = (ts_cyc&0xF) << 12;
 644
 645                /* now actually write the timestamp into the appropriate CIP headers */
 646                if (f->cip_syt1) {
 647                        f->cip_syt1->b[6] = f->assigned_timestamp >> 8;
 648                        f->cip_syt1->b[7] = f->assigned_timestamp & 0xFF;
 649                }
 650                if (f->cip_syt2) {
 651                        f->cip_syt2->b[6] = f->assigned_timestamp >> 8;
 652                        f->cip_syt2->b[7] = f->assigned_timestamp & 0xFF;
 653                }
 654
 655                /* --- start DMA --- */
 656
 657                /* clear all bits in ContextControl register */
 658
 659                reg_write(video->ohci, video->ohci_IsoXmitContextControlClear, 0xFFFFFFFF);
 660                wmb();
 661
 662                /* the OHCI card has the ability to start ISO transmission on a
 663                   particular cycle (start-on-cycle). This way we can ensure that
 664                   the first DV frame will have an accurate timestamp.
 665
 666                   However, start-on-cycle only appears to work if the OHCI card
 667                   is cycle master! Since the consequences of messing up the first
 668                   timestamp are minimal*, just disable start-on-cycle for now.
 669
 670                   * my DV deck drops the first few frames before it "locks in;"
 671                     so the first frame having an incorrect timestamp is inconsequential.
 672                */
 673
 674#if 0
 675                reg_write(video->ohci, video->ohci_IsoXmitContextControlSet,
 676                          (1 << 31) /* enable start-on-cycle */
 677                          | ( (transmit_sec & 0x3) << 29)
 678                          | (transmit_cyc << 16));
 679                wmb();
 680#endif
 681
 682                video->dma_running = 1;
 683
 684                /* set the 'run' bit */
 685                reg_write(video->ohci, video->ohci_IsoXmitContextControlSet, 0x8000);
 686                flush_pci_write(video->ohci);
 687
 688                /* --- DMA should be running now --- */
 689
 690                debug_printk("    Cycle = %4u ContextControl = %08x CmdPtr = %08x\n",
 691                             (reg_read(video->ohci, OHCI1394_IsochronousCycleTimer) >> 12) & 0x1FFF,
 692                             reg_read(video->ohci, video->ohci_IsoXmitContextControlSet),
 693                             reg_read(video->ohci, video->ohci_IsoXmitCommandPtr));
 694
 695                debug_printk("    DMA start - current cycle %4u, transmit cycle %4u (%2u), assigning ts cycle %2u\n",
 696                             ct_cyc, transmit_cyc, transmit_cyc & 0xF, ts_cyc & 0xF);
 697
 698#if DV1394_DEBUG_LEVEL >= 2
 699                {
 700                        /* check if DMA is really running */
 701                        int i = 0;
 702                        while (i < 20) {
 703                                mb();
 704                                mdelay(1);
 705                                if (reg_read(video->ohci, video->ohci_IsoXmitContextControlSet) & (1 << 10)) {
 706                                        printk("DMA ACTIVE after %d msec\n", i);
 707                                        break;
 708                                }
 709                                i++;
 710                        }
 711
 712                        printk("set = %08x, cmdPtr = %08x\n",
 713                               reg_read(video->ohci, video->ohci_IsoXmitContextControlSet),
 714                               reg_read(video->ohci, video->ohci_IsoXmitCommandPtr)
 715                               );
 716
 717                        if ( ! (reg_read(video->ohci, video->ohci_IsoXmitContextControlSet) &  (1 << 10)) ) {
 718                                printk("DMA did NOT go active after 20ms, event = %x\n",
 719                                       reg_read(video->ohci, video->ohci_IsoXmitContextControlSet) & 0x1F);
 720                        } else
 721                                printk("DMA is RUNNING!\n");
 722                }
 723#endif
 724
 725        }
 726
 727
 728        spin_unlock_irqrestore(&video->spinlock, irq_flags);
 729}
 730
 731
 732
 733/*** RECEIVE FUNCTIONS *****************************************************/
 734
 735/*
 736        frame method put_packet
 737
 738        map and copy the packet data to its location in the frame
 739        based upon DIF section and sequence
 740*/
 741
 742static void inline
 743frame_put_packet (struct frame *f, struct packet *p)
 744{
 745        int section_type = p->data[0] >> 5;           /* section type is in bits 5 - 7 */
 746        int dif_sequence = p->data[1] >> 4;           /* dif sequence number is in bits 4 - 7 */
 747        int dif_block = p->data[2];
 748
 749        /* sanity check */
 750        if (dif_sequence > 11 || dif_block > 149) return;
 751
 752        switch (section_type) {
 753        case 0:           /* 1 Header block */
 754                memcpy( (void *) f->data + dif_sequence * 150 * 80, p->data, 480);
 755                break;
 756
 757        case 1:           /* 2 Subcode blocks */
 758                memcpy( (void *) f->data + dif_sequence * 150 * 80 + (1 + dif_block) * 80, p->data, 480);
 759                break;
 760
 761        case 2:           /* 3 VAUX blocks */
 762                memcpy( (void *) f->data + dif_sequence * 150 * 80 + (3 + dif_block) * 80, p->data, 480);
 763                break;
 764
 765        case 3:           /* 9 Audio blocks interleaved with video */
 766                memcpy( (void *) f->data + dif_sequence * 150 * 80 + (6 + dif_block * 16) * 80, p->data, 480);
 767                break;
 768
 769        case 4:           /* 135 Video blocks interleaved with audio */
 770                memcpy( (void *) f->data + dif_sequence * 150 * 80 + (7 + (dif_block / 15) + dif_block) * 80, p->data, 480);
 771                break;
 772
 773        default:           /* we can not handle any other data */
 774                break;
 775        }
 776}
 777
 778
 779static void start_dma_receive(struct video_card *video)
 780{
 781        if (video->first_run == 1) {
 782                video->first_run = 0;
 783
 784                /* start DMA once all of the frames are READY */
 785                video->n_clear_frames = 0;
 786                video->first_clear_frame = -1;
 787                video->current_packet = 0;
 788                video->active_frame = 0;
 789
 790                /* reset iso recv control register */
 791                reg_write(video->ohci, video->ohci_IsoRcvContextControlClear, 0xFFFFFFFF);
 792                wmb();
 793
 794                /* clear bufferFill, set isochHeader and speed (0=100) */
 795                reg_write(video->ohci, video->ohci_IsoRcvContextControlSet, 0x40000000);
 796
 797                /* match on all tags, listen on channel */
 798                reg_write(video->ohci, video->ohci_IsoRcvContextMatch, 0xf0000000 | video->channel);
 799
 800                /* address and first descriptor block + Z=1 */
 801                reg_write(video->ohci, video->ohci_IsoRcvCommandPtr,
 802                          video->frames[0]->descriptor_pool_dma | 1); /* Z=1 */
 803                wmb();
 804
 805                video->dma_running = 1;
 806
 807                /* run */
 808                reg_write(video->ohci, video->ohci_IsoRcvContextControlSet, 0x8000);
 809                flush_pci_write(video->ohci);
 810
 811                debug_printk("dv1394: DMA started\n");
 812
 813#if DV1394_DEBUG_LEVEL >= 2
 814                {
 815                        int i;
 816
 817                        for (i = 0; i < 1000; ++i) {
 818                                mdelay(1);
 819                                if (reg_read(video->ohci, video->ohci_IsoRcvContextControlSet) & (1 << 10)) {
 820                                        printk("DMA ACTIVE after %d msec\n", i);
 821                                        break;
 822                                }
 823                        }
 824                        if ( reg_read(video->ohci, video->ohci_IsoRcvContextControlSet) &  (1 << 11) ) {
 825                                printk("DEAD, event = %x\n",
 826                                           reg_read(video->ohci, video->ohci_IsoRcvContextControlSet) & 0x1F);
 827                        } else
 828                                printk("RUNNING!\n");
 829                }
 830#endif
 831        } else if ( reg_read(video->ohci, video->ohci_IsoRcvContextControlSet) &  (1 << 11) ) {
 832                debug_printk("DEAD, event = %x\n",
 833                             reg_read(video->ohci, video->ohci_IsoRcvContextControlSet) & 0x1F);
 834
 835                /* wake */
 836                reg_write(video->ohci, video->ohci_IsoRcvContextControlSet, (1 << 12));
 837        }
 838}
 839
 840
 841/*
 842   receive_packets() - build the DMA program for receiving
 843*/
 844
 845static void receive_packets(struct video_card *video)
 846{
 847        struct DMA_descriptor_block *block = NULL;
 848        dma_addr_t block_dma = 0;
 849        struct packet *data = NULL;
 850        dma_addr_t data_dma = 0;
 851        __le32 *last_branch_address = NULL;
 852        unsigned long irq_flags;
 853        int want_interrupt = 0;
 854        struct frame *f = NULL;
 855        int i, j;
 856
 857        spin_lock_irqsave(&video->spinlock, irq_flags);
 858
 859        for (j = 0; j < video->n_frames; j++) {
 860
 861                /* connect frames */
 862                if (j > 0 && f != NULL && f->frame_end_branch != NULL)
 863                        *(f->frame_end_branch) = cpu_to_le32(video->frames[j]->descriptor_pool_dma | 1); /* set Z=1 */
 864
 865                f = video->frames[j];
 866
 867                for (i = 0; i < MAX_PACKETS; i++) {
 868                        /* locate a descriptor block and packet from the buffer */
 869                        block = &(f->descriptor_pool[i]);
 870                        block_dma = ((unsigned long) block - (unsigned long) f->descriptor_pool) + f->descriptor_pool_dma;
 871
 872                        data = ((struct packet*)video->packet_buf.kvirt) + f->frame_num * MAX_PACKETS + i;
 873                        data_dma = dma_region_offset_to_bus( &video->packet_buf,
 874                                                             ((unsigned long) data - (unsigned long) video->packet_buf.kvirt) );
 875
 876                        /* setup DMA descriptor block */
 877                        want_interrupt = ((i % (MAX_PACKETS/2)) == 0 || i == (MAX_PACKETS-1));
 878                        fill_input_last( &(block->u.in.il), want_interrupt, 512, data_dma);
 879
 880                        /* link descriptors */
 881                        last_branch_address = f->frame_end_branch;
 882
 883                        if (last_branch_address != NULL)
 884                                *(last_branch_address) = cpu_to_le32(block_dma | 1); /* set Z=1 */
 885
 886                        f->frame_end_branch = &(block->u.in.il.q[2]);
 887                }
 888
 889        } /* next j */
 890
 891        spin_unlock_irqrestore(&video->spinlock, irq_flags);
 892
 893}
 894
 895
 896
 897/*** MANAGEMENT FUNCTIONS **************************************************/
 898
 899static int do_dv1394_init(struct video_card *video, struct dv1394_init *init)
 900{
 901        unsigned long flags, new_buf_size;
 902        int i;
 903        u64 chan_mask;
 904        int retval = -EINVAL;
 905
 906        debug_printk("dv1394: initialising %d\n", video->id);
 907        if (init->api_version != DV1394_API_VERSION)
 908                return -EINVAL;
 909
 910        /* first sanitize all the parameters */
 911        if ( (init->n_frames < 2) || (init->n_frames > DV1394_MAX_FRAMES) )
 912                return -EINVAL;
 913
 914        if ( (init->format != DV1394_NTSC) && (init->format != DV1394_PAL) )
 915                return -EINVAL;
 916
 917        if ( (init->syt_offset == 0) || (init->syt_offset > 50) )
 918                /* default SYT offset is 3 cycles */
 919                init->syt_offset = 3;
 920
 921        if (init->channel > 63)
 922                init->channel = 63;
 923
 924        chan_mask = (u64)1 << init->channel;
 925
 926        /* calculate what size DMA buffer is needed */
 927        if (init->format == DV1394_NTSC)
 928                new_buf_size = DV1394_NTSC_FRAME_SIZE * init->n_frames;
 929        else
 930                new_buf_size = DV1394_PAL_FRAME_SIZE * init->n_frames;
 931
 932        /* round up to PAGE_SIZE */
 933        if (new_buf_size % PAGE_SIZE) new_buf_size += PAGE_SIZE - (new_buf_size % PAGE_SIZE);
 934
 935        /* don't allow the user to allocate the DMA buffer more than once */
 936        if (video->dv_buf.kvirt && video->dv_buf_size != new_buf_size) {
 937                printk("dv1394: re-sizing the DMA buffer is not allowed\n");
 938                return -EINVAL;
 939        }
 940
 941        /* shutdown the card if it's currently active */
 942        /* (the card should not be reset if the parameters are screwy) */
 943
 944        do_dv1394_shutdown(video, 0);
 945
 946        /* try to claim the ISO channel */
 947        spin_lock_irqsave(&video->ohci->IR_channel_lock, flags);
 948        if (video->ohci->ISO_channel_usage & chan_mask) {
 949                spin_unlock_irqrestore(&video->ohci->IR_channel_lock, flags);
 950                retval = -EBUSY;
 951                goto err;
 952        }
 953        video->ohci->ISO_channel_usage |= chan_mask;
 954        spin_unlock_irqrestore(&video->ohci->IR_channel_lock, flags);
 955
 956        video->channel = init->channel;
 957
 958        /* initialize misc. fields of video */
 959        video->n_frames = init->n_frames;
 960        video->pal_or_ntsc = init->format;
 961
 962        video->cip_accum = 0;
 963        video->continuity_counter = 0;
 964
 965        video->active_frame = -1;
 966        video->first_clear_frame = 0;
 967        video->n_clear_frames = video->n_frames;
 968        video->dropped_frames = 0;
 969
 970        video->write_off = 0;
 971
 972        video->first_run = 1;
 973        video->current_packet = -1;
 974        video->first_frame = 0;
 975
 976        if (video->pal_or_ntsc == DV1394_NTSC) {
 977                video->cip_n = init->cip_n != 0 ? init->cip_n : CIP_N_NTSC;
 978                video->cip_d = init->cip_d != 0 ? init->cip_d : CIP_D_NTSC;
 979                video->frame_size = DV1394_NTSC_FRAME_SIZE;
 980        } else {
 981                video->cip_n = init->cip_n != 0 ? init->cip_n : CIP_N_PAL;
 982                video->cip_d = init->cip_d != 0 ? init->cip_d : CIP_D_PAL;
 983                video->frame_size = DV1394_PAL_FRAME_SIZE;
 984        }
 985
 986        video->syt_offset = init->syt_offset;
 987
 988        /* find and claim DMA contexts on the OHCI card */
 989
 990        if (video->ohci_it_ctx == -1) {
 991                ohci1394_init_iso_tasklet(&video->it_tasklet, OHCI_ISO_TRANSMIT,
 992                                          it_tasklet_func, (unsigned long) video);
 993
 994                if (ohci1394_register_iso_tasklet(video->ohci, &video->it_tasklet) < 0) {
 995                        printk(KERN_ERR "dv1394: could not find an available IT DMA context\n");
 996                        retval = -EBUSY;
 997                        goto err;
 998                }
 999
1000                video->ohci_it_ctx = video->it_tasklet.context;
1001                debug_printk("dv1394: claimed IT DMA context %d\n", video->ohci_it_ctx);
1002        }
1003
1004        if (video->ohci_ir_ctx == -1) {
1005                ohci1394_init_iso_tasklet(&video->ir_tasklet, OHCI_ISO_RECEIVE,
1006                                          ir_tasklet_func, (unsigned long) video);
1007
1008                if (ohci1394_register_iso_tasklet(video->ohci, &video->ir_tasklet) < 0) {
1009                        printk(KERN_ERR "dv1394: could not find an available IR DMA context\n");
1010                        retval = -EBUSY;
1011                        goto err;
1012                }
1013                video->ohci_ir_ctx = video->ir_tasklet.context;
1014                debug_printk("dv1394: claimed IR DMA context %d\n", video->ohci_ir_ctx);
1015        }
1016
1017        /* allocate struct frames */
1018        for (i = 0; i < init->n_frames; i++) {
1019                video->frames[i] = frame_new(i, video);
1020
1021                if (!video->frames[i]) {
1022                        printk(KERN_ERR "dv1394: Cannot allocate frame structs\n");
1023                        retval = -ENOMEM;
1024                        goto err;
1025                }
1026        }
1027
1028        if (!video->dv_buf.kvirt) {
1029                /* allocate the ringbuffer */
1030                retval = dma_region_alloc(&video->dv_buf, new_buf_size, video->ohci->dev, PCI_DMA_TODEVICE);
1031                if (retval)
1032                        goto err;
1033
1034                video->dv_buf_size = new_buf_size;
1035
1036                debug_printk("dv1394: Allocated %d frame buffers, total %u pages (%u DMA pages), %lu bytes\n", 
1037                             video->n_frames, video->dv_buf.n_pages,
1038                             video->dv_buf.n_dma_pages, video->dv_buf_size);
1039        }
1040
1041        /* set up the frame->data pointers */
1042        for (i = 0; i < video->n_frames; i++)
1043                video->frames[i]->data = (unsigned long) video->dv_buf.kvirt + i * video->frame_size;
1044
1045        if (!video->packet_buf.kvirt) {
1046                /* allocate packet buffer */
1047                video->packet_buf_size = sizeof(struct packet) * video->n_frames * MAX_PACKETS;
1048                if (video->packet_buf_size % PAGE_SIZE)
1049                        video->packet_buf_size += PAGE_SIZE - (video->packet_buf_size % PAGE_SIZE);
1050
1051                retval = dma_region_alloc(&video->packet_buf, video->packet_buf_size,
1052                                          video->ohci->dev, PCI_DMA_FROMDEVICE);
1053                if (retval)
1054                        goto err;
1055
1056                debug_printk("dv1394: Allocated %d packets in buffer, total %u pages (%u DMA pages), %lu bytes\n",
1057                                 video->n_frames*MAX_PACKETS, video->packet_buf.n_pages,
1058                                 video->packet_buf.n_dma_pages, video->packet_buf_size);
1059        }
1060
1061        /* set up register offsets for IT context */
1062        /* IT DMA context registers are spaced 16 bytes apart */
1063        video->ohci_IsoXmitContextControlSet = OHCI1394_IsoXmitContextControlSet+16*video->ohci_it_ctx;
1064        video->ohci_IsoXmitContextControlClear = OHCI1394_IsoXmitContextControlClear+16*video->ohci_it_ctx;
1065        video->ohci_IsoXmitCommandPtr = OHCI1394_IsoXmitCommandPtr+16*video->ohci_it_ctx;
1066
1067        /* enable interrupts for IT context */
1068        reg_write(video->ohci, OHCI1394_IsoXmitIntMaskSet, (1 << video->ohci_it_ctx));
1069        debug_printk("dv1394: interrupts enabled for IT context %d\n", video->ohci_it_ctx);
1070
1071        /* set up register offsets for IR context */
1072        /* IR DMA context registers are spaced 32 bytes apart */
1073        video->ohci_IsoRcvContextControlSet = OHCI1394_IsoRcvContextControlSet+32*video->ohci_ir_ctx;
1074        video->ohci_IsoRcvContextControlClear = OHCI1394_IsoRcvContextControlClear+32*video->ohci_ir_ctx;
1075        video->ohci_IsoRcvCommandPtr = OHCI1394_IsoRcvCommandPtr+32*video->ohci_ir_ctx;
1076        video->ohci_IsoRcvContextMatch = OHCI1394_IsoRcvContextMatch+32*video->ohci_ir_ctx;
1077
1078        /* enable interrupts for IR context */
1079        reg_write(video->ohci, OHCI1394_IsoRecvIntMaskSet, (1 << video->ohci_ir_ctx) );
1080        debug_printk("dv1394: interrupts enabled for IR context %d\n", video->ohci_ir_ctx);
1081
1082        return 0;
1083
1084err:
1085        do_dv1394_shutdown(video, 1);
1086        return retval;
1087}
1088
1089/* if the user doesn't bother to call ioctl(INIT) before starting
1090   mmap() or read()/write(), just give him some default values */
1091
1092static int do_dv1394_init_default(struct video_card *video)
1093{
1094        struct dv1394_init init;
1095
1096        init.api_version = DV1394_API_VERSION;
1097        init.n_frames = DV1394_MAX_FRAMES / 4;
1098        init.channel = video->channel;
1099        init.format = video->pal_or_ntsc;
1100        init.cip_n = video->cip_n;
1101        init.cip_d = video->cip_d;
1102        init.syt_offset = video->syt_offset;
1103
1104        return do_dv1394_init(video, &init);
1105}
1106
1107/* do NOT call from interrupt context */
1108static void stop_dma(struct video_card *video)
1109{
1110        unsigned long flags;
1111        int i;
1112
1113        /* no interrupts */
1114        spin_lock_irqsave(&video->spinlock, flags);
1115
1116        video->dma_running = 0;
1117
1118        if ( (video->ohci_it_ctx == -1) && (video->ohci_ir_ctx == -1) )
1119                goto out;
1120
1121        /* stop DMA if in progress */
1122        if ( (video->active_frame != -1) ||
1123            (reg_read(video->ohci, video->ohci_IsoXmitContextControlClear) & (1 << 10)) ||
1124            (reg_read(video->ohci, video->ohci_IsoRcvContextControlClear) &  (1 << 10)) ) {
1125
1126                /* clear the .run bits */
1127                reg_write(video->ohci, video->ohci_IsoXmitContextControlClear, (1 << 15));
1128                reg_write(video->ohci, video->ohci_IsoRcvContextControlClear, (1 << 15));
1129                flush_pci_write(video->ohci);
1130
1131                video->active_frame = -1;
1132                video->first_run = 1;
1133
1134                /* wait until DMA really stops */
1135                i = 0;
1136                while (i < 1000) {
1137
1138                        /* wait 0.1 millisecond */
1139                        udelay(100);
1140
1141                        if ( (reg_read(video->ohci, video->ohci_IsoXmitContextControlClear) & (1 << 10)) ||
1142                            (reg_read(video->ohci, video->ohci_IsoRcvContextControlClear)  & (1 << 10)) ) {
1143                                /* still active */
1144                                debug_printk("dv1394: stop_dma: DMA not stopped yet\n" );
1145                                mb();
1146                        } else {
1147                                debug_printk("dv1394: stop_dma: DMA stopped safely after %d ms\n", i/10);
1148                                break;
1149                        }
1150
1151                        i++;
1152                }
1153
1154                if (i == 1000) {
1155                        printk(KERN_ERR "dv1394: stop_dma: DMA still going after %d ms!\n", i/10);
1156                }
1157        }
1158        else
1159                debug_printk("dv1394: stop_dma: already stopped.\n");
1160
1161out:
1162        spin_unlock_irqrestore(&video->spinlock, flags);
1163}
1164
1165
1166
1167static void do_dv1394_shutdown(struct video_card *video, int free_dv_buf)
1168{
1169        int i;
1170
1171        debug_printk("dv1394: shutdown...\n");
1172
1173        /* stop DMA if in progress */
1174        stop_dma(video);
1175
1176        /* release the DMA contexts */
1177        if (video->ohci_it_ctx != -1) {
1178                video->ohci_IsoXmitContextControlSet = 0;
1179                video->ohci_IsoXmitContextControlClear = 0;
1180                video->ohci_IsoXmitCommandPtr = 0;
1181
1182                /* disable interrupts for IT context */
1183                reg_write(video->ohci, OHCI1394_IsoXmitIntMaskClear, (1 << video->ohci_it_ctx));
1184
1185                /* remove tasklet */
1186                ohci1394_unregister_iso_tasklet(video->ohci, &video->it_tasklet);
1187                debug_printk("dv1394: IT context %d released\n", video->ohci_it_ctx);
1188                video->ohci_it_ctx = -1;
1189        }
1190
1191        if (video->ohci_ir_ctx != -1) {
1192                video->ohci_IsoRcvContextControlSet = 0;
1193                video->ohci_IsoRcvContextControlClear = 0;
1194                video->ohci_IsoRcvCommandPtr = 0;
1195                video->ohci_IsoRcvContextMatch = 0;
1196
1197                /* disable interrupts for IR context */
1198                reg_write(video->ohci, OHCI1394_IsoRecvIntMaskClear, (1 << video->ohci_ir_ctx));
1199
1200                /* remove tasklet */
1201                ohci1394_unregister_iso_tasklet(video->ohci, &video->ir_tasklet);
1202                debug_printk("dv1394: IR context %d released\n", video->ohci_ir_ctx);
1203                video->ohci_ir_ctx = -1;
1204        }
1205
1206        /* release the ISO channel */
1207        if (video->channel != -1) {
1208                u64 chan_mask;
1209                unsigned long flags;
1210
1211                chan_mask = (u64)1 << video->channel;
1212
1213                spin_lock_irqsave(&video->ohci->IR_channel_lock, flags);
1214                video->ohci->ISO_channel_usage &= ~(chan_mask);
1215                spin_unlock_irqrestore(&video->ohci->IR_channel_lock, flags);
1216
1217                video->channel = -1;
1218        }
1219
1220        /* free the frame structs */
1221        for (i = 0; i < DV1394_MAX_FRAMES; i++) {
1222                if (video->frames[i])
1223                        frame_delete(video->frames[i]);
1224                video->frames[i] = NULL;
1225        }
1226
1227        video->n_frames = 0;
1228
1229        /* we can't free the DMA buffer unless it is guaranteed that
1230           no more user-space mappings exist */
1231
1232        if (free_dv_buf) {
1233                dma_region_free(&video->dv_buf);
1234                video->dv_buf_size = 0;
1235        }
1236
1237        /* free packet buffer */
1238        dma_region_free(&video->packet_buf);
1239        video->packet_buf_size = 0;
1240
1241        debug_printk("dv1394: shutdown OK\n");
1242}
1243
1244/*
1245       **********************************
1246       *** MMAP() THEORY OF OPERATION ***
1247       **********************************
1248
1249        The ringbuffer cannot be re-allocated or freed while
1250        a user program maintains a mapping of it. (note that a mapping
1251        can persist even after the device fd is closed!)
1252
1253        So, only let the user process allocate the DMA buffer once.
1254        To resize or deallocate it, you must close the device file
1255        and open it again.
1256
1257        Previously Dan M. hacked out a scheme that allowed the DMA
1258        buffer to change by forcefully unmapping it from the user's
1259        address space. It was prone to error because it's very hard to
1260        track all the places the buffer could have been mapped (we
1261        would have had to walk the vma list of every process in the
1262        system to be sure we found all the mappings!). Instead, we
1263        force the user to choose one buffer size and stick with
1264        it. This small sacrifice is worth the huge reduction in
1265        error-prone code in dv1394.
1266*/
1267
1268static int dv1394_mmap(struct file *file, struct vm_area_struct *vma)
1269{
1270        struct video_card *video = file_to_video_card(file);
1271        int retval = -EINVAL;
1272
1273        /*
1274         * We cannot use the blocking variant mutex_lock here because .mmap
1275         * is called with mmap_sem held, while .ioctl, .read, .write acquire
1276         * video->mtx and subsequently call copy_to/from_user which will
1277         * grab mmap_sem in case of a page fault.
1278         */
1279        if (!mutex_trylock(&video->mtx))
1280                return -EAGAIN;
1281
1282        if ( ! video_card_initialized(video) ) {
1283                retval = do_dv1394_init_default(video);
1284                if (retval)
1285                        goto out;
1286        }
1287
1288        retval = dma_region_mmap(&video->dv_buf, file, vma);
1289out:
1290        mutex_unlock(&video->mtx);
1291        return retval;
1292}
1293
1294/*** DEVICE FILE INTERFACE *************************************************/
1295
1296/* no need to serialize, multiple threads OK */
1297static unsigned int dv1394_poll(struct file *file, struct poll_table_struct *wait)
1298{
1299        struct video_card *video = file_to_video_card(file);
1300        unsigned int mask = 0;
1301        unsigned long flags;
1302
1303        poll_wait(file, &video->waitq, wait);
1304
1305        spin_lock_irqsave(&video->spinlock, flags);
1306        if ( video->n_frames == 0 ) {
1307
1308        } else if ( video->active_frame == -1 ) {
1309                /* nothing going on */
1310                mask |= POLLOUT;
1311        } else {
1312                /* any clear/ready buffers? */
1313                if (video->n_clear_frames >0)
1314                        mask |= POLLOUT | POLLIN;
1315        }
1316        spin_unlock_irqrestore(&video->spinlock, flags);
1317
1318        return mask;
1319}
1320
1321static int dv1394_fasync(int fd, struct file *file, int on)
1322{
1323        /* I just copied this code verbatim from Alan Cox's mouse driver example
1324           (Documentation/DocBook/) */
1325
1326        struct video_card *video = file_to_video_card(file);
1327
1328        return fasync_helper(fd, file, on, &video->fasync);
1329}
1330
1331static ssize_t dv1394_write(struct file *file, const char __user *buffer, size_t count, loff_t *ppos)
1332{
1333        struct video_card *video = file_to_video_card(file);
1334        DECLARE_WAITQUEUE(wait, current);
1335        ssize_t ret;
1336        size_t cnt;
1337        unsigned long flags;
1338        int target_frame;
1339
1340        /* serialize this to prevent multi-threaded mayhem */
1341        if (file->f_flags & O_NONBLOCK) {
1342                if (!mutex_trylock(&video->mtx))
1343                        return -EAGAIN;
1344        } else {
1345                if (mutex_lock_interruptible(&video->mtx))
1346                        return -ERESTARTSYS;
1347        }
1348
1349        if ( !video_card_initialized(video) ) {
1350                ret = do_dv1394_init_default(video);
1351                if (ret) {
1352                        mutex_unlock(&video->mtx);
1353                        return ret;
1354                }
1355        }
1356
1357        ret = 0;
1358        add_wait_queue(&video->waitq, &wait);
1359
1360        while (count > 0) {
1361
1362                /* must set TASK_INTERRUPTIBLE *before* checking for free
1363                   buffers; otherwise we could miss a wakeup if the interrupt
1364                   fires between the check and the schedule() */
1365
1366                set_current_state(TASK_INTERRUPTIBLE);
1367
1368                spin_lock_irqsave(&video->spinlock, flags);
1369
1370                target_frame = video->first_clear_frame;
1371
1372                spin_unlock_irqrestore(&video->spinlock, flags);
1373
1374                if (video->frames[target_frame]->state == FRAME_CLEAR) {
1375
1376                        /* how much room is left in the target frame buffer */
1377                        cnt = video->frame_size - (video->write_off - target_frame * video->frame_size);
1378
1379                } else {
1380                        /* buffer is already used */
1381                        cnt = 0;
1382                }
1383
1384                if (cnt > count)
1385                        cnt = count;
1386
1387                if (cnt <= 0) {
1388                        /* no room left, gotta wait */
1389                        if (file->f_flags & O_NONBLOCK) {
1390                                if (!ret)
1391                                        ret = -EAGAIN;
1392                                break;
1393                        }
1394                        if (signal_pending(current)) {
1395                                if (!ret)
1396                                        ret = -ERESTARTSYS;
1397                                break;
1398                        }
1399
1400                        schedule();
1401
1402                        continue; /* start over from 'while(count > 0)...' */
1403                }
1404
1405                if (copy_from_user(video->dv_buf.kvirt + video->write_off, buffer, cnt)) {
1406                        if (!ret)
1407                                ret = -EFAULT;
1408                        break;
1409                }
1410
1411                video->write_off = (video->write_off + cnt) % (video->n_frames * video->frame_size);
1412
1413                count -= cnt;
1414                buffer += cnt;
1415                ret += cnt;
1416
1417                if (video->write_off == video->frame_size * ((target_frame + 1) % video->n_frames))
1418                                frame_prepare(video, target_frame);
1419        }
1420
1421        remove_wait_queue(&video->waitq, &wait);
1422        set_current_state(TASK_RUNNING);
1423        mutex_unlock(&video->mtx);
1424        return ret;
1425}
1426
1427
1428static ssize_t dv1394_read(struct file *file,  char __user *buffer, size_t count, loff_t *ppos)
1429{
1430        struct video_card *video = file_to_video_card(file);
1431        DECLARE_WAITQUEUE(wait, current);
1432        ssize_t ret;
1433        size_t cnt;
1434        unsigned long flags;
1435        int target_frame;
1436
1437        /* serialize this to prevent multi-threaded mayhem */
1438        if (file->f_flags & O_NONBLOCK) {
1439                if (!mutex_trylock(&video->mtx))
1440                        return -EAGAIN;
1441        } else {
1442                if (mutex_lock_interruptible(&video->mtx))
1443                        return -ERESTARTSYS;
1444        }
1445
1446        if ( !video_card_initialized(video) ) {
1447                ret = do_dv1394_init_default(video);
1448                if (ret) {
1449                        mutex_unlock(&video->mtx);
1450                        return ret;
1451                }
1452                video->continuity_counter = -1;
1453
1454                receive_packets(video);
1455
1456                start_dma_receive(video);
1457        }
1458
1459        ret = 0;
1460        add_wait_queue(&video->waitq, &wait);
1461
1462        while (count > 0) {
1463
1464                /* must set TASK_INTERRUPTIBLE *before* checking for free
1465                   buffers; otherwise we could miss a wakeup if the interrupt
1466                   fires between the check and the schedule() */
1467
1468                set_current_state(TASK_INTERRUPTIBLE);
1469
1470                spin_lock_irqsave(&video->spinlock, flags);
1471
1472                target_frame = video->first_clear_frame;
1473
1474                spin_unlock_irqrestore(&video->spinlock, flags);
1475
1476                if (target_frame >= 0 &&
1477                        video->n_clear_frames > 0 &&
1478                        video->frames[target_frame]->state == FRAME_CLEAR) {
1479
1480                        /* how much room is left in the target frame buffer */
1481                        cnt = video->frame_size - (video->write_off - target_frame * video->frame_size);
1482
1483                } else {
1484                        /* buffer is already used */
1485                        cnt = 0;
1486                }
1487
1488                if (cnt > count)
1489                        cnt = count;
1490
1491                if (cnt <= 0) {
1492                        /* no room left, gotta wait */
1493                        if (file->f_flags & O_NONBLOCK) {
1494                                if (!ret)
1495                                        ret = -EAGAIN;
1496                                break;
1497                        }
1498                        if (signal_pending(current)) {
1499                                if (!ret)
1500                                        ret = -ERESTARTSYS;
1501                                break;
1502                        }
1503
1504                        schedule();
1505
1506                        continue; /* start over from 'while(count > 0)...' */
1507                }
1508
1509                if (copy_to_user(buffer, video->dv_buf.kvirt + video->write_off, cnt)) {
1510                                if (!ret)
1511                                        ret = -EFAULT;
1512                                break;
1513                }
1514
1515                video->write_off = (video->write_off + cnt) % (video->n_frames * video->frame_size);
1516
1517                count -= cnt;
1518                buffer += cnt;
1519                ret += cnt;
1520
1521                if (video->write_off == video->frame_size * ((target_frame + 1) % video->n_frames)) {
1522                        spin_lock_irqsave(&video->spinlock, flags);
1523                        video->n_clear_frames--;
1524                        video->first_clear_frame = (video->first_clear_frame + 1) % video->n_frames;
1525                        spin_unlock_irqrestore(&video->spinlock, flags);
1526                }
1527        }
1528
1529        remove_wait_queue(&video->waitq, &wait);
1530        set_current_state(TASK_RUNNING);
1531        mutex_unlock(&video->mtx);
1532        return ret;
1533}
1534
1535
1536/*** DEVICE IOCTL INTERFACE ************************************************/
1537
1538static long dv1394_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
1539{
1540        struct video_card *video = file_to_video_card(file);
1541        unsigned long flags;
1542        int ret = -EINVAL;
1543        void __user *argp = (void __user *)arg;
1544
1545        DECLARE_WAITQUEUE(wait, current);
1546
1547        /* serialize this to prevent multi-threaded mayhem */
1548        if (file->f_flags & O_NONBLOCK) {
1549                if (!mutex_trylock(&video->mtx))
1550                        return -EAGAIN;
1551        } else {
1552                if (mutex_lock_interruptible(&video->mtx))
1553                        return -ERESTARTSYS;
1554        }
1555
1556        switch(cmd)
1557        {
1558        case DV1394_IOC_SUBMIT_FRAMES: {
1559                unsigned int n_submit;
1560
1561                if ( !video_card_initialized(video) ) {
1562                        ret = do_dv1394_init_default(video);
1563                        if (ret)
1564                                goto out;
1565                }
1566
1567                n_submit = (unsigned int) arg;
1568
1569                if (n_submit > video->n_frames) {
1570                        ret = -EINVAL;
1571                        goto out;
1572                }
1573
1574                while (n_submit > 0) {
1575
1576                        add_wait_queue(&video->waitq, &wait);
1577                        set_current_state(TASK_INTERRUPTIBLE);
1578
1579                        spin_lock_irqsave(&video->spinlock, flags);
1580
1581                        /* wait until video->first_clear_frame is really CLEAR */
1582                        while (video->frames[video->first_clear_frame]->state != FRAME_CLEAR) {
1583
1584                                spin_unlock_irqrestore(&video->spinlock, flags);
1585
1586                                if (signal_pending(current)) {
1587                                        remove_wait_queue(&video->waitq, &wait);
1588                                        set_current_state(TASK_RUNNING);
1589                                        ret = -EINTR;
1590                                        goto out;
1591                                }
1592
1593                                schedule();
1594                                set_current_state(TASK_INTERRUPTIBLE);
1595
1596                                spin_lock_irqsave(&video->spinlock, flags);
1597                        }
1598                        spin_unlock_irqrestore(&video->spinlock, flags);
1599
1600                        remove_wait_queue(&video->waitq, &wait);
1601                        set_current_state(TASK_RUNNING);
1602
1603                        frame_prepare(video, video->first_clear_frame);
1604
1605                        n_submit--;
1606                }
1607
1608                ret = 0;
1609                break;
1610        }
1611
1612        case DV1394_IOC_WAIT_FRAMES: {
1613                unsigned int n_wait;
1614
1615                if ( !video_card_initialized(video) ) {
1616                        ret = -EINVAL;
1617                        goto out;
1618                }
1619
1620                n_wait = (unsigned int) arg;
1621
1622                /* since we re-run the last frame on underflow, we will
1623                   never actually have n_frames clear frames; at most only
1624                   n_frames - 1 */
1625
1626                if (n_wait > (video->n_frames-1) ) {
1627                        ret = -EINVAL;
1628                        goto out;
1629                }
1630
1631                add_wait_queue(&video->waitq, &wait);
1632                set_current_state(TASK_INTERRUPTIBLE);
1633
1634                spin_lock_irqsave(&video->spinlock, flags);
1635
1636                while (video->n_clear_frames < n_wait) {
1637
1638                        spin_unlock_irqrestore(&video->spinlock, flags);
1639
1640                        if (signal_pending(current)) {
1641                                remove_wait_queue(&video->waitq, &wait);
1642                                set_current_state(TASK_RUNNING);
1643                                ret = -EINTR;
1644                                goto out;
1645                        }
1646
1647                        schedule();
1648                        set_current_state(TASK_INTERRUPTIBLE);
1649
1650                        spin_lock_irqsave(&video->spinlock, flags);
1651                }
1652
1653                spin_unlock_irqrestore(&video->spinlock, flags);
1654
1655                remove_wait_queue(&video->waitq, &wait);
1656                set_current_state(TASK_RUNNING);
1657                ret = 0;
1658                break;
1659        }
1660
1661        case DV1394_IOC_RECEIVE_FRAMES: {
1662                unsigned int n_recv;
1663
1664                if ( !video_card_initialized(video) ) {
1665                        ret = -EINVAL;
1666                        goto out;
1667                }
1668
1669                n_recv = (unsigned int) arg;
1670
1671                /* at least one frame must be active */
1672                if (n_recv > (video->n_frames-1) ) {
1673                        ret = -EINVAL;
1674                        goto out;
1675                }
1676
1677                spin_lock_irqsave(&video->spinlock, flags);
1678
1679                /* release the clear frames */
1680                video->n_clear_frames -= n_recv;
1681
1682                /* advance the clear frame cursor */
1683                video->first_clear_frame = (video->first_clear_frame + n_recv) % video->n_frames;
1684
1685                /* reset dropped_frames */
1686                video->dropped_frames = 0;
1687
1688                spin_unlock_irqrestore(&video->spinlock, flags);
1689
1690                ret = 0;
1691                break;
1692        }
1693
1694        case DV1394_IOC_START_RECEIVE: {
1695                if ( !video_card_initialized(video) ) {
1696                        ret = do_dv1394_init_default(video);
1697                        if (ret)
1698                                goto out;
1699                }
1700
1701                video->continuity_counter = -1;
1702
1703                receive_packets(video);
1704
1705                start_dma_receive(video);
1706
1707                ret = 0;
1708                break;
1709        }
1710
1711        case DV1394_IOC_INIT: {
1712                struct dv1394_init init;
1713                if (!argp) {
1714                        ret = do_dv1394_init_default(video);
1715                } else {
1716                        if (copy_from_user(&init, argp, sizeof(init))) {
1717                                ret = -EFAULT;
1718                                goto out;
1719                        }
1720                        ret = do_dv1394_init(video, &init);
1721                }
1722                break;
1723        }
1724
1725        case DV1394_IOC_SHUTDOWN:
1726                do_dv1394_shutdown(video, 0);
1727                ret = 0;
1728                break;
1729
1730
1731        case DV1394_IOC_GET_STATUS: {
1732                struct dv1394_status status;
1733
1734                if ( !video_card_initialized(video) ) {
1735                        ret = -EINVAL;
1736                        goto out;
1737                }
1738
1739                status.init.api_version = DV1394_API_VERSION;
1740                status.init.channel = video->channel;
1741                status.init.n_frames = video->n_frames;
1742                status.init.format = video->pal_or_ntsc;
1743                status.init.cip_n = video->cip_n;
1744                status.init.cip_d = video->cip_d;
1745                status.init.syt_offset = video->syt_offset;
1746
1747                status.first_clear_frame = video->first_clear_frame;
1748
1749                /* the rest of the fields need to be locked against the interrupt */
1750                spin_lock_irqsave(&video->spinlock, flags);
1751
1752                status.active_frame = video->active_frame;
1753                status.n_clear_frames = video->n_clear_frames;
1754
1755                status.dropped_frames = video->dropped_frames;
1756
1757                /* reset dropped_frames */
1758                video->dropped_frames = 0;
1759
1760                spin_unlock_irqrestore(&video->spinlock, flags);
1761
1762                if (copy_to_user(argp, &status, sizeof(status))) {
1763                        ret = -EFAULT;
1764                        goto out;
1765                }
1766
1767                ret = 0;
1768                break;
1769        }
1770
1771        default:
1772                break;
1773        }
1774
1775 out:
1776        mutex_unlock(&video->mtx);
1777        return ret;
1778}
1779
1780/*** DEVICE FILE INTERFACE CONTINUED ***************************************/
1781
1782static int dv1394_open(struct inode *inode, struct file *file)
1783{
1784        struct video_card *video = NULL;
1785
1786        if (file->private_data) {
1787                video = (struct video_card*) file->private_data;
1788
1789        } else {
1790                /* look up the card by ID */
1791                unsigned long flags;
1792                int idx = ieee1394_file_to_instance(file);
1793
1794                spin_lock_irqsave(&dv1394_cards_lock, flags);
1795                if (!list_empty(&dv1394_cards)) {
1796                        struct video_card *p;
1797                        list_for_each_entry(p, &dv1394_cards, list) {
1798                                if ((p->id) == idx) {
1799                                        video = p;
1800                                        break;
1801                                }
1802                        }
1803                }
1804                spin_unlock_irqrestore(&dv1394_cards_lock, flags);
1805
1806                if (!video) {
1807                        debug_printk("dv1394: OHCI card %d not found", idx);
1808                        return -ENODEV;
1809                }
1810
1811                file->private_data = (void*) video;
1812        }
1813
1814#ifndef DV1394_ALLOW_MORE_THAN_ONE_OPEN
1815
1816        if ( test_and_set_bit(0, &video->open) ) {
1817                /* video is already open by someone else */
1818                return -EBUSY;
1819        }
1820
1821#endif
1822
1823        printk(KERN_INFO "%s: NOTE, the dv1394 interface is unsupported "
1824               "and will not be available in the new firewire driver stack. "
1825               "Try libraw1394 based programs instead.\n", current->comm);
1826
1827        return 0;
1828}
1829
1830
1831static int dv1394_release(struct inode *inode, struct file *file)
1832{
1833        struct video_card *video = file_to_video_card(file);
1834
1835        /* OK to free the DMA buffer, no more mappings can exist */
1836        do_dv1394_shutdown(video, 1);
1837
1838        /* give someone else a turn */
1839        clear_bit(0, &video->open);
1840
1841        return 0;
1842}
1843
1844
1845/*** DEVICE DRIVER HANDLERS ************************************************/
1846
1847static void it_tasklet_func(unsigned long data)
1848{
1849        int wake = 0;
1850        struct video_card *video = (struct video_card*) data;
1851
1852        spin_lock(&video->spinlock);
1853
1854        if (!video->dma_running)
1855                goto out;
1856
1857        irq_printk("ContextControl = %08x, CommandPtr = %08x\n",
1858               reg_read(video->ohci, video->ohci_IsoXmitContextControlSet),
1859               reg_read(video->ohci, video->ohci_IsoXmitCommandPtr)
1860               );
1861
1862
1863        if ( (video->ohci_it_ctx != -1) &&
1864            (reg_read(video->ohci, video->ohci_IsoXmitContextControlSet) & (1 << 10)) ) {
1865
1866                struct frame *f;
1867                unsigned int frame, i;
1868
1869
1870                if (video->active_frame == -1)
1871                        frame = 0;
1872                else
1873                        frame = video->active_frame;
1874
1875                /* check all the DMA-able frames */
1876                for (i = 0; i < video->n_frames; i++, frame = (frame+1) % video->n_frames) {
1877
1878                        irq_printk("IRQ checking frame %d...", frame);
1879                        f = video->frames[frame];
1880                        if (f->state != FRAME_READY) {
1881                                irq_printk("clear, skipping\n");
1882                                /* we don't own this frame */
1883                                continue;
1884                        }
1885
1886                        irq_printk("DMA\n");
1887
1888                        /* check the frame begin semaphore to see if we can free the previous frame */
1889                        if ( *(f->frame_begin_timestamp) ) {
1890                                int prev_frame;
1891                                struct frame *prev_f;
1892
1893
1894
1895                                /* don't reset, need this later *(f->frame_begin_timestamp) = 0; */
1896                                irq_printk("  BEGIN\n");
1897
1898                                prev_frame = frame - 1;
1899                                if (prev_frame == -1)
1900                                        prev_frame += video->n_frames;
1901                                prev_f = video->frames[prev_frame];
1902
1903                                /* make sure we can actually garbage collect
1904                                   this frame */
1905                                if ( (prev_f->state == FRAME_READY) &&
1906                                    prev_f->done && (!f->done) )
1907                                {
1908                                        frame_reset(prev_f);
1909                                        video->n_clear_frames++;
1910                                        wake = 1;
1911                                        video->active_frame = frame;
1912
1913                                        irq_printk("  BEGIN - freeing previous frame %d, new active frame is %d\n", prev_frame, frame);
1914                                } else {
1915                                        irq_printk("  BEGIN - can't free yet\n");
1916                                }
1917
1918                                f->done = 1;
1919                        }
1920
1921
1922                        /* see if we need to set the timestamp for the next frame */
1923                        if ( *(f->mid_frame_timestamp) ) {
1924                                struct frame *next_frame;
1925                                u32 begin_ts, ts_cyc, ts_off;
1926
1927                                *(f->mid_frame_timestamp) = 0;
1928
1929                                begin_ts = le32_to_cpu(*(f->frame_begin_timestamp));
1930
1931                                irq_printk("  MIDDLE - first packet was sent at cycle %4u (%2u), assigned timestamp was (%2u) %4u\n",
1932                                           begin_ts & 0x1FFF, begin_ts & 0xF,
1933                                           f->assigned_timestamp >> 12, f->assigned_timestamp & 0xFFF);
1934
1935                                /* prepare next frame and assign timestamp */
1936                                next_frame = video->frames[ (frame+1) % video->n_frames ];
1937
1938                                if (next_frame->state == FRAME_READY) {
1939                                        irq_printk("  MIDDLE - next frame is ready, good\n");
1940                                } else {
1941                                        debug_printk("dv1394: Underflow! At least one frame has been dropped.\n");
1942                                        next_frame = f;
1943                                }
1944
1945                                /* set the timestamp to the timestamp of the last frame sent,
1946                                   plus the length of the last frame sent, plus the syt latency */
1947                                ts_cyc = begin_ts & 0xF;
1948                                /* advance one frame, plus syt latency (typically 2-3) */
1949                                ts_cyc += f->n_packets + video->syt_offset ;
1950
1951                                ts_off = 0;
1952
1953                                ts_cyc += ts_off/3072;
1954                                ts_off %= 3072;
1955
1956                                next_frame->assigned_timestamp = ((ts_cyc&0xF) << 12) + ts_off;
1957                                if (next_frame->cip_syt1) {
1958                                        next_frame->cip_syt1->b[6] = next_frame->assigned_timestamp >> 8;
1959                                        next_frame->cip_syt1->b[7] = next_frame->assigned_timestamp & 0xFF;
1960                                }
1961                                if (next_frame->cip_syt2) {
1962                                        next_frame->cip_syt2->b[6] = next_frame->assigned_timestamp >> 8;
1963                                        next_frame->cip_syt2->b[7] = next_frame->assigned_timestamp & 0xFF;
1964                                }
1965
1966                        }
1967
1968                        /* see if the frame looped */
1969                        if ( *(f->frame_end_timestamp) ) {
1970
1971                                *(f->frame_end_timestamp) = 0;
1972
1973                                debug_printk("  END - the frame looped at least once\n");
1974
1975                                video->dropped_frames++;
1976                        }
1977
1978                } /* for (each frame) */
1979        }
1980
1981        if (wake) {
1982                kill_fasync(&video->fasync, SIGIO, POLL_OUT);
1983
1984                /* wake readers/writers/ioctl'ers */
1985                wake_up_interruptible(&video->waitq);
1986        }
1987
1988out:
1989        spin_unlock(&video->spinlock);
1990}
1991
1992static void ir_tasklet_func(unsigned long data)
1993{
1994        int wake = 0;
1995        struct video_card *video = (struct video_card*) data;
1996
1997        spin_lock(&video->spinlock);
1998
1999        if (!video->dma_running)
2000                goto out;
2001
2002        if ( (video->ohci_ir_ctx != -1) &&
2003            (reg_read(video->ohci, video->ohci_IsoRcvContextControlSet) & (1 << 10)) ) {
2004
2005                int sof=0; /* start-of-frame flag */
2006                struct frame *f;
2007                u16 packet_length, packet_time;
2008                int i, dbc=0;
2009                struct DMA_descriptor_block *block = NULL;
2010                u16 xferstatus;
2011
2012                int next_i, prev_i;
2013                struct DMA_descriptor_block *next = NULL;
2014                dma_addr_t next_dma = 0;
2015                struct DMA_descriptor_block *prev = NULL;
2016
2017                /* loop over all descriptors in all frames */
2018                for (i = 0; i < video->n_frames*MAX_PACKETS; i++) {
2019                        struct packet *p = dma_region_i(&video->packet_buf, struct packet, video->current_packet);
2020
2021                        /* make sure we are seeing the latest changes to p */
2022                        dma_region_sync_for_cpu(&video->packet_buf,
2023                                                (unsigned long) p - (unsigned long) video->packet_buf.kvirt,
2024                                                sizeof(struct packet));
2025
2026                        packet_length = le16_to_cpu(p->data_length);
2027                        packet_time   = le16_to_cpu(p->timestamp);
2028
2029                        irq_printk("received packet %02d, timestamp=%04x, length=%04x, sof=%02x%02x\n", video->current_packet,
2030                                   packet_time, packet_length,
2031                                   p->data[0], p->data[1]);
2032
2033                        /* get the descriptor based on packet_buffer cursor */
2034                        f = video->frames[video->current_packet / MAX_PACKETS];
2035                        block = &(f->descriptor_pool[video->current_packet % MAX_PACKETS]);
2036                        xferstatus = le32_to_cpu(block->u.in.il.q[3]) >> 16;
2037                        xferstatus &= 0x1F;
2038                        irq_printk("ir_tasklet_func: xferStatus/resCount [%d] = 0x%08x\n", i, le32_to_cpu(block->u.in.il.q[3]) );
2039
2040                        /* get the current frame */
2041                        f = video->frames[video->active_frame];
2042
2043                        /* exclude empty packet */
2044                        if (packet_length > 8 && xferstatus == 0x11) {
2045                                /* check for start of frame */
2046                                /* DRD> Changed to check section type ([0]>>5==0)
2047                                   and dif sequence ([1]>>4==0) */
2048                                sof = ( (p->data[0] >> 5) == 0 && (p->data[1] >> 4) == 0);
2049
2050                                dbc = (int) (p->cip_h1 >> 24);
2051                                if ( video->continuity_counter != -1 && dbc > ((video->continuity_counter + 1) % 256) )
2052                                {
2053                                        printk(KERN_WARNING "dv1394: discontinuity detected, dropping all frames\n" );
2054                                        video->dropped_frames += video->n_clear_frames + 1;
2055                                        video->first_frame = 0;
2056                                        video->n_clear_frames = 0;
2057                                        video->first_clear_frame = -1;
2058                                }
2059                                video->continuity_counter = dbc;
2060
2061                                if (!video->first_frame) {
2062                                        if (sof) {
2063                                                video->first_frame = 1;
2064                                        }
2065
2066                                } else if (sof) {
2067                                        /* close current frame */
2068                                        frame_reset(f);  /* f->state = STATE_CLEAR */
2069                                        video->n_clear_frames++;
2070                                        if (video->n_clear_frames > video->n_frames) {
2071                                                video->dropped_frames++;
2072                                                printk(KERN_WARNING "dv1394: dropped a frame during reception\n" );
2073                                                video->n_clear_frames = video->n_frames-1;
2074                                                video->first_clear_frame = (video->first_clear_frame + 1) % video->n_frames;
2075                                        }
2076                                        if (video->first_clear_frame == -1)
2077                                                video->first_clear_frame = video->active_frame;
2078
2079                                        /* get the next frame */
2080                                        video->active_frame = (video->active_frame + 1) % video->n_frames;
2081                                        f = video->frames[video->active_frame];
2082                                        irq_printk("   frame received, active_frame = %d, n_clear_frames = %d, first_clear_frame = %d\n",
2083                                                   video->active_frame, video->n_clear_frames, video->first_clear_frame);
2084                                }
2085                                if (video->first_frame) {
2086                                        if (sof) {
2087                                                /* open next frame */
2088                                                f->state = FRAME_READY;
2089                                        }
2090
2091                                        /* copy to buffer */
2092                                        if (f->n_packets > (video->frame_size / 480)) {
2093                                                printk(KERN_ERR "frame buffer overflow during receive\n");
2094                                        }
2095
2096                                        frame_put_packet(f, p);
2097
2098                                } /* first_frame */
2099                        }
2100
2101                        /* stop, end of ready packets */
2102                        else if (xferstatus == 0) {
2103                                break;
2104                        }
2105
2106                        /* reset xferStatus & resCount */
2107                        block->u.in.il.q[3] = cpu_to_le32(512);
2108
2109                        /* terminate dma chain at this (next) packet */
2110                        next_i = video->current_packet;
2111                        f = video->frames[next_i / MAX_PACKETS];
2112                        next = &(f->descriptor_pool[next_i % MAX_PACKETS]);
2113                        next_dma = ((unsigned long) block - (unsigned long) f->descriptor_pool) + f->descriptor_pool_dma;
2114                        next->u.in.il.q[0] |= cpu_to_le32(3 << 20); /* enable interrupt */
2115                        next->u.in.il.q[2] = cpu_to_le32(0); /* disable branch */
2116
2117                        /* link previous to next */
2118                        prev_i = (next_i == 0) ? (MAX_PACKETS * video->n_frames - 1) : (next_i - 1);
2119                        f = video->frames[prev_i / MAX_PACKETS];
2120                        prev = &(f->descriptor_pool[prev_i % MAX_PACKETS]);
2121                        if (prev_i % (MAX_PACKETS/2)) {
2122                                prev->u.in.il.q[0] &= ~cpu_to_le32(3 << 20); /* no interrupt */
2123                        } else {
2124                                prev->u.in.il.q[0] |= cpu_to_le32(3 << 20); /* enable interrupt */
2125                        }
2126                        prev->u.in.il.q[2] = cpu_to_le32(next_dma | 1); /* set Z=1 */
2127                        wmb();
2128
2129                        /* wake up DMA in case it fell asleep */
2130                        reg_write(video->ohci, video->ohci_IsoRcvContextControlSet, (1 << 12));
2131
2132                        /* advance packet_buffer cursor */
2133                        video->current_packet = (video->current_packet + 1) % (MAX_PACKETS * video->n_frames);
2134
2135                } /* for all packets */
2136
2137                wake = 1; /* why the hell not? */
2138
2139        } /* receive interrupt */
2140
2141        if (wake) {
2142                kill_fasync(&video->fasync, SIGIO, POLL_IN);
2143
2144                /* wake readers/writers/ioctl'ers */
2145                wake_up_interruptible(&video->waitq);
2146        }
2147
2148out:
2149        spin_unlock(&video->spinlock);
2150}
2151
2152static struct cdev dv1394_cdev;
2153static const struct file_operations dv1394_fops=
2154{
2155        .owner =        THIS_MODULE,
2156        .poll =         dv1394_poll,
2157        .unlocked_ioctl = dv1394_ioctl,
2158#ifdef CONFIG_COMPAT
2159        .compat_ioctl = dv1394_compat_ioctl,
2160#endif
2161        .mmap =         dv1394_mmap,
2162        .open =         dv1394_open,
2163        .write =        dv1394_write,
2164        .read =         dv1394_read,
2165        .release =      dv1394_release,
2166        .fasync =       dv1394_fasync,
2167};
2168
2169
2170/*** HOTPLUG STUFF **********************************************************/
2171/*
2172 * Export information about protocols/devices supported by this driver.
2173 */
2174#ifdef MODULE
2175static const struct ieee1394_device_id dv1394_id_table[] = {
2176        {
2177                .match_flags    = IEEE1394_MATCH_SPECIFIER_ID | IEEE1394_MATCH_VERSION,
2178                .specifier_id   = AVC_UNIT_SPEC_ID_ENTRY & 0xffffff,
2179                .version        = AVC_SW_VERSION_ENTRY & 0xffffff
2180        },
2181        { }
2182};
2183
2184MODULE_DEVICE_TABLE(ieee1394, dv1394_id_table);
2185#endif /* MODULE */
2186
2187static struct hpsb_protocol_driver dv1394_driver = {
2188        .name = "dv1394",
2189};
2190
2191
2192/*** IEEE1394 HPSB CALLBACKS ***********************************************/
2193
2194static int dv1394_init(struct ti_ohci *ohci, enum pal_or_ntsc format, enum modes mode)
2195{
2196        struct video_card *video;
2197        unsigned long flags;
2198        int i;
2199
2200        video = kzalloc(sizeof(*video), GFP_KERNEL);
2201        if (!video) {
2202                printk(KERN_ERR "dv1394: cannot allocate video_card\n");
2203                return -1;
2204        }
2205
2206        video->ohci = ohci;
2207        /* lower 2 bits of id indicate which of four "plugs"
2208           per host */
2209        video->id = ohci->host->id << 2;
2210        if (format == DV1394_NTSC)
2211                video->id |= mode;
2212        else
2213                video->id |= 2 + mode;
2214
2215        video->ohci_it_ctx = -1;
2216        video->ohci_ir_ctx = -1;
2217
2218        video->ohci_IsoXmitContextControlSet = 0;
2219        video->ohci_IsoXmitContextControlClear = 0;
2220        video->ohci_IsoXmitCommandPtr = 0;
2221
2222        video->ohci_IsoRcvContextControlSet = 0;
2223        video->ohci_IsoRcvContextControlClear = 0;
2224        video->ohci_IsoRcvCommandPtr = 0;
2225        video->ohci_IsoRcvContextMatch = 0;
2226
2227        video->n_frames = 0; /* flag that video is not initialized */
2228        video->channel = 63; /* default to broadcast channel */
2229        video->active_frame = -1;
2230
2231        /* initialize the following */
2232        video->pal_or_ntsc = format;
2233        video->cip_n = 0; /* 0 = use builtin default */
2234        video->cip_d = 0;
2235        video->syt_offset = 0;
2236        video->mode = mode;
2237
2238        for (i = 0; i < DV1394_MAX_FRAMES; i++)
2239                video->frames[i] = NULL;
2240
2241        dma_region_init(&video->dv_buf);
2242        video->dv_buf_size = 0;
2243        dma_region_init(&video->packet_buf);
2244        video->packet_buf_size = 0;
2245
2246        clear_bit(0, &video->open);
2247        spin_lock_init(&video->spinlock);
2248        video->dma_running = 0;
2249        mutex_init(&video->mtx);
2250        init_waitqueue_head(&video->waitq);
2251        video->fasync = NULL;
2252
2253        spin_lock_irqsave(&dv1394_cards_lock, flags);
2254        INIT_LIST_HEAD(&video->list);
2255        list_add_tail(&video->list, &dv1394_cards);
2256        spin_unlock_irqrestore(&dv1394_cards_lock, flags);
2257
2258        debug_printk("dv1394: dv1394_init() OK on ID %d\n", video->id);
2259        return 0;
2260}
2261
2262static void dv1394_remove_host(struct hpsb_host *host)
2263{
2264        struct video_card *video, *tmp_video;
2265        unsigned long flags;
2266        int found_ohci_card = 0;
2267
2268        do {
2269                video = NULL;
2270                spin_lock_irqsave(&dv1394_cards_lock, flags);
2271                list_for_each_entry(tmp_video, &dv1394_cards, list) {
2272                        if ((tmp_video->id >> 2) == host->id) {
2273                                list_del(&tmp_video->list);
2274                                video = tmp_video;
2275                                found_ohci_card = 1;
2276                                break;
2277                        }
2278                }
2279                spin_unlock_irqrestore(&dv1394_cards_lock, flags);
2280
2281                if (video) {
2282                        do_dv1394_shutdown(video, 1);
2283                        kfree(video);
2284                }
2285        } while (video);
2286
2287        if (found_ohci_card)
2288                device_destroy(hpsb_protocol_class, MKDEV(IEEE1394_MAJOR,
2289                           IEEE1394_MINOR_BLOCK_DV1394 * 16 + (host->id << 2)));
2290}
2291
2292static void dv1394_add_host(struct hpsb_host *host)
2293{
2294        struct ti_ohci *ohci;
2295        int id = host->id;
2296
2297        /* We only work with the OHCI-1394 driver */
2298        if (strcmp(host->driver->name, OHCI1394_DRIVER_NAME))
2299                return;
2300
2301        ohci = (struct ti_ohci *)host->hostdata;
2302
2303        device_create(hpsb_protocol_class, NULL,
2304                      MKDEV(IEEE1394_MAJOR,
2305                            IEEE1394_MINOR_BLOCK_DV1394 * 16 + (id<<2)),
2306                      NULL, "dv1394-%d", id);
2307
2308        dv1394_init(ohci, DV1394_NTSC, MODE_RECEIVE);
2309        dv1394_init(ohci, DV1394_NTSC, MODE_TRANSMIT);
2310        dv1394_init(ohci, DV1394_PAL, MODE_RECEIVE);
2311        dv1394_init(ohci, DV1394_PAL, MODE_TRANSMIT);
2312}
2313
2314
2315/* Bus reset handler. In the event of a bus reset, we may need to
2316   re-start the DMA contexts - otherwise the user program would
2317   end up waiting forever.
2318*/
2319
2320static void dv1394_host_reset(struct hpsb_host *host)
2321{
2322        struct ti_ohci *ohci;
2323        struct video_card *video = NULL, *tmp_vid;
2324        unsigned long flags;
2325
2326        /* We only work with the OHCI-1394 driver */
2327        if (strcmp(host->driver->name, OHCI1394_DRIVER_NAME))
2328                return;
2329
2330        ohci = (struct ti_ohci *)host->hostdata;
2331
2332
2333        /* find the corresponding video_cards */
2334        spin_lock_irqsave(&dv1394_cards_lock, flags);
2335        list_for_each_entry(tmp_vid, &dv1394_cards, list) {
2336                if ((tmp_vid->id >> 2) == host->id) {
2337                        video = tmp_vid;
2338                        break;
2339                }
2340        }
2341        spin_unlock_irqrestore(&dv1394_cards_lock, flags);
2342
2343        if (!video)
2344                return;
2345
2346
2347        spin_lock_irqsave(&video->spinlock, flags);
2348
2349        if (!video->dma_running)
2350                goto out;
2351
2352        /* check IT context */
2353        if (video->ohci_it_ctx != -1) {
2354                u32 ctx;
2355
2356                ctx = reg_read(video->ohci, video->ohci_IsoXmitContextControlSet);
2357
2358                /* if (RUN but not ACTIVE) */
2359                if ( (ctx & (1<<15)) &&
2360                    !(ctx & (1<<10)) ) {
2361
2362                        debug_printk("dv1394: IT context stopped due to bus reset; waking it up\n");
2363
2364                        /* to be safe, assume a frame has been dropped. User-space programs
2365                           should handle this condition like an underflow. */
2366                        video->dropped_frames++;
2367
2368                        /* for some reason you must clear, then re-set the RUN bit to restart DMA */
2369
2370                        /* clear RUN */
2371                        reg_write(video->ohci, video->ohci_IsoXmitContextControlClear, (1 << 15));
2372                        flush_pci_write(video->ohci);
2373
2374                        /* set RUN */
2375                        reg_write(video->ohci, video->ohci_IsoXmitContextControlSet, (1 << 15));
2376                        flush_pci_write(video->ohci);
2377
2378                        /* set the WAKE bit (just in case; this isn't strictly necessary) */
2379                        reg_write(video->ohci, video->ohci_IsoXmitContextControlSet, (1 << 12));
2380                        flush_pci_write(video->ohci);
2381
2382                        irq_printk("dv1394: AFTER IT restart ctx 0x%08x ptr 0x%08x\n",
2383                                   reg_read(video->ohci, video->ohci_IsoXmitContextControlSet),
2384                                   reg_read(video->ohci, video->ohci_IsoXmitCommandPtr));
2385                }
2386        }
2387
2388        /* check IR context */
2389        if (video->ohci_ir_ctx != -1) {
2390                u32 ctx;
2391
2392                ctx = reg_read(video->ohci, video->ohci_IsoRcvContextControlSet);
2393
2394                /* if (RUN but not ACTIVE) */
2395                if ( (ctx & (1<<15)) &&
2396                    !(ctx & (1<<10)) ) {
2397
2398                        debug_printk("dv1394: IR context stopped due to bus reset; waking it up\n");
2399
2400                        /* to be safe, assume a frame has been dropped. User-space programs
2401                           should handle this condition like an overflow. */
2402                        video->dropped_frames++;
2403
2404                        /* for some reason you must clear, then re-set the RUN bit to restart DMA */
2405                        /* XXX this doesn't work for me, I can't get IR DMA to restart :[ */
2406
2407                        /* clear RUN */
2408                        reg_write(video->ohci, video->ohci_IsoRcvContextControlClear, (1 << 15));
2409                        flush_pci_write(video->ohci);
2410
2411                        /* set RUN */
2412                        reg_write(video->ohci, video->ohci_IsoRcvContextControlSet, (1 << 15));
2413                        flush_pci_write(video->ohci);
2414
2415                        /* set the WAKE bit (just in case; this isn't strictly necessary) */
2416                        reg_write(video->ohci, video->ohci_IsoRcvContextControlSet, (1 << 12));
2417                        flush_pci_write(video->ohci);
2418
2419                        irq_printk("dv1394: AFTER IR restart ctx 0x%08x ptr 0x%08x\n",
2420                                   reg_read(video->ohci, video->ohci_IsoRcvContextControlSet),
2421                                   reg_read(video->ohci, video->ohci_IsoRcvCommandPtr));
2422                }
2423        }
2424
2425out:
2426        spin_unlock_irqrestore(&video->spinlock, flags);
2427
2428        /* wake readers/writers/ioctl'ers */
2429        wake_up_interruptible(&video->waitq);
2430}
2431
2432static struct hpsb_highlevel dv1394_highlevel = {
2433        .name =         "dv1394",
2434        .add_host =     dv1394_add_host,
2435        .remove_host =  dv1394_remove_host,
2436        .host_reset =   dv1394_host_reset,
2437};
2438
2439#ifdef CONFIG_COMPAT
2440
2441#define DV1394_IOC32_INIT       _IOW('#', 0x06, struct dv1394_init32)
2442#define DV1394_IOC32_GET_STATUS _IOR('#', 0x0c, struct dv1394_status32)
2443
2444struct dv1394_init32 {
2445        u32 api_version;
2446        u32 channel;
2447        u32 n_frames;
2448        u32 format;
2449        u32 cip_n;
2450        u32 cip_d;
2451        u32 syt_offset;
2452};
2453
2454struct dv1394_status32 {
2455        struct dv1394_init32 init;
2456        s32 active_frame;
2457        u32 first_clear_frame;
2458        u32 n_clear_frames;
2459        u32 dropped_frames;
2460};
2461
2462/* RED-PEN: this should use compat_alloc_userspace instead */
2463
2464static int handle_dv1394_init(struct file *file, unsigned int cmd, unsigned long arg)
2465{
2466        struct dv1394_init32 dv32;
2467        struct dv1394_init dv;
2468        mm_segment_t old_fs;
2469        int ret;
2470
2471        if (file->f_op->unlocked_ioctl != dv1394_ioctl)
2472                return -EFAULT;
2473
2474        if (copy_from_user(&dv32, (void __user *)arg, sizeof(dv32)))
2475                return -EFAULT;
2476
2477        dv.api_version = dv32.api_version;
2478        dv.channel = dv32.channel;
2479        dv.n_frames = dv32.n_frames;
2480        dv.format = dv32.format;
2481        dv.cip_n = (unsigned long)dv32.cip_n;
2482        dv.cip_d = (unsigned long)dv32.cip_d;
2483        dv.syt_offset = dv32.syt_offset;
2484
2485        old_fs = get_fs();
2486        set_fs(KERNEL_DS);
2487        ret = dv1394_ioctl(file, DV1394_IOC_INIT, (unsigned long)&dv);
2488        set_fs(old_fs);
2489
2490        return ret;
2491}
2492
2493static int handle_dv1394_get_status(struct file *file, unsigned int cmd, unsigned long arg)
2494{
2495        struct dv1394_status32 dv32;
2496        struct dv1394_status dv;
2497        mm_segment_t old_fs;
2498        int ret;
2499
2500        if (file->f_op->unlocked_ioctl != dv1394_ioctl)
2501                return -EFAULT;
2502
2503        old_fs = get_fs();
2504        set_fs(KERNEL_DS);
2505        ret = dv1394_ioctl(file, DV1394_IOC_GET_STATUS, (unsigned long)&dv);
2506        set_fs(old_fs);
2507
2508        if (!ret) {
2509                dv32.init.api_version = dv.init.api_version;
2510                dv32.init.channel = dv.init.channel;
2511                dv32.init.n_frames = dv.init.n_frames;
2512                dv32.init.format = dv.init.format;
2513                dv32.init.cip_n = (u32)dv.init.cip_n;
2514                dv32.init.cip_d = (u32)dv.init.cip_d;
2515                dv32.init.syt_offset = dv.init.syt_offset;
2516                dv32.active_frame = dv.active_frame;
2517                dv32.first_clear_frame = dv.first_clear_frame;
2518                dv32.n_clear_frames = dv.n_clear_frames;
2519                dv32.dropped_frames = dv.dropped_frames;
2520
2521                if (copy_to_user((struct dv1394_status32 __user *)arg, &dv32, sizeof(dv32)))
2522                        ret = -EFAULT;
2523        }
2524
2525        return ret;
2526}
2527
2528
2529
2530static long dv1394_compat_ioctl(struct file *file, unsigned int cmd,
2531                               unsigned long arg)
2532{
2533        switch (cmd) {
2534        case DV1394_IOC_SHUTDOWN:
2535        case DV1394_IOC_SUBMIT_FRAMES:
2536        case DV1394_IOC_WAIT_FRAMES:
2537        case DV1394_IOC_RECEIVE_FRAMES:
2538        case DV1394_IOC_START_RECEIVE:
2539                return dv1394_ioctl(file, cmd, arg);
2540
2541        case DV1394_IOC32_INIT:
2542                return handle_dv1394_init(file, cmd, arg);
2543        case DV1394_IOC32_GET_STATUS:
2544                return handle_dv1394_get_status(file, cmd, arg);
2545        default:
2546                return -ENOIOCTLCMD;
2547        }
2548}
2549
2550#endif /* CONFIG_COMPAT */
2551
2552
2553/*** KERNEL MODULE HANDLERS ************************************************/
2554
2555MODULE_AUTHOR("Dan Maas <dmaas@dcine.com>, Dan Dennedy <dan@dennedy.org>");
2556MODULE_DESCRIPTION("driver for DV input/output on OHCI board");
2557MODULE_SUPPORTED_DEVICE("dv1394");
2558MODULE_LICENSE("GPL");
2559
2560static void __exit dv1394_exit_module(void)
2561{
2562        hpsb_unregister_protocol(&dv1394_driver);
2563        hpsb_unregister_highlevel(&dv1394_highlevel);
2564        cdev_del(&dv1394_cdev);
2565}
2566
2567static int __init dv1394_init_module(void)
2568{
2569        int ret;
2570
2571        cdev_init(&dv1394_cdev, &dv1394_fops);
2572        dv1394_cdev.owner = THIS_MODULE;
2573        ret = cdev_add(&dv1394_cdev, IEEE1394_DV1394_DEV, 16);
2574        if (ret) {
2575                printk(KERN_ERR "dv1394: unable to register character device\n");
2576                return ret;
2577        }
2578
2579        hpsb_register_highlevel(&dv1394_highlevel);
2580
2581        ret = hpsb_register_protocol(&dv1394_driver);
2582        if (ret) {
2583                printk(KERN_ERR "dv1394: failed to register protocol\n");
2584                hpsb_unregister_highlevel(&dv1394_highlevel);
2585                cdev_del(&dv1394_cdev);
2586                return ret;
2587        }
2588
2589        return 0;
2590}
2591
2592module_init(dv1394_init_module);
2593module_exit(dv1394_exit_module);
2594