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