drivers/firewire/fw-iso.c

   1 /*                                              -*- c-basic-offset: 8 -*-
   2  *
   3  * fw-iso.c - Isochronous IO
   4  * Copyright (C) 2006 Kristian Hoegsberg <krh@bitplanet.net>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, write to the Free Software Foundation,
  18  * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  19  */
  20
  21 #include <linux/kernel.h>
  22 #include <linux/module.h>
  23 #include <linux/dma-mapping.h>
  24 #include <linux/vmalloc.h>
  25 #include <linux/mm.h>
  26
  27 #include "fw-transaction.h"
  28 #include "fw-topology.h"
  29 #include "fw-device.h"
  30
  31 int
  32 fw_iso_buffer_init(struct fw_iso_buffer *buffer, struct fw_card *card,
  33                    int page_count, enum dma_data_direction direction)
  34 {
  35         int i, j, retval = -ENOMEM;
  36         dma_addr_t address;
  37
  38         buffer->page_count = page_count;
  39         buffer->direction = direction;
  40
  41         buffer->pages = kmalloc(page_count * sizeof(buffer->pages[0]),
  42                                 GFP_KERNEL);
  43         if (buffer->pages == NULL)
  44                 goto out;
  45
  46         for (i = 0; i < buffer->page_count; i++) {
  47                 buffer->pages[i] = alloc_page(GFP_KERNEL | GFP_DMA32);
  48                 if (buffer->pages[i] == NULL)
  49                         goto out_pages;
  50
  51                 address = dma_map_page(card->device, buffer->pages[i],
  52                                        0, PAGE_SIZE, direction);
  53                 if (dma_mapping_error(address)) {
  54                         __free_page(buffer->pages[i]);
  55                         goto out_pages;
  56                 }
  57                 set_page_private(buffer->pages[i], address);
  58         }
  59
  60         return 0;
  61
  62  out_pages:
  63         for (j = 0; j < i; j++) {
  64                 address = page_private(buffer->pages[j]);
  65                 dma_unmap_page(card->device, address,
  66                                PAGE_SIZE, DMA_TO_DEVICE);
  67                 __free_page(buffer->pages[j]);
  68         }
  69         kfree(buffer->pages);
  70  out:
  71         buffer->pages = NULL;
  72         return retval;
  73 }
  74
  75 int fw_iso_buffer_map(struct fw_iso_buffer *buffer, struct vm_area_struct *vma)
  76 {
  77         unsigned long uaddr;
  78         int i, retval;
  79
  80         uaddr = vma->vm_start;
  81         for (i = 0; i < buffer->page_count; i++) {
  82                 retval = vm_insert_page(vma, uaddr, buffer->pages[i]);
  83                 if (retval)
  84                         return retval;
  85                 uaddr += PAGE_SIZE;
  86         }
  87
  88         return 0;
  89 }
  90
  91 void fw_iso_buffer_destroy(struct fw_iso_buffer *buffer,
  92                            struct fw_card *card)
  93 {
  94         int i;
  95         dma_addr_t address;
  96
  97         for (i = 0; i < buffer->page_count; i++) {
  98                 address = page_private(buffer->pages[i]);
  99                 dma_unmap_page(card->device, address,
 100                                PAGE_SIZE, DMA_TO_DEVICE);
 101                 __free_page(buffer->pages[i]);
 102         }
 103
 104         kfree(buffer->pages);
 105         buffer->pages = NULL;
 106 }
 107
 108 struct fw_iso_context *
 109 fw_iso_context_create(struct fw_card *card, int type, size_t header_size,
 110                       fw_iso_callback_t callback, void *callback_data)
 111 {
 112         struct fw_iso_context *ctx;
 113
 114         ctx = card->driver->allocate_iso_context(card, type);
 115         if (IS_ERR(ctx))
 116                 return ctx;
 117
 118         ctx->card = card;
 119         ctx->type = type;
 120         ctx->header_size = header_size;
 121         ctx->callback = callback;
 122         ctx->callback_data = callback_data;
 123
 124         return ctx;
 125 }
 126 EXPORT_SYMBOL(fw_iso_context_create);
 127
 128 void fw_iso_context_destroy(struct fw_iso_context *ctx)
 129 {
 130         struct fw_card *card = ctx->card;
 131
 132         card->driver->free_iso_context(ctx);
 133 }
 134 EXPORT_SYMBOL(fw_iso_context_destroy);
 135
 136 int
 137 fw_iso_context_start(struct fw_iso_context *ctx,
 138                      int channel, int speed, int cycle)
 139 {
 140         ctx->channel = channel;
 141         ctx->speed = speed;
 142
 143         return ctx->card->driver->start_iso(ctx, cycle);
 144 }
 145 EXPORT_SYMBOL(fw_iso_context_start);
 146
 147 int
 148 fw_iso_context_queue(struct fw_iso_context *ctx,
 149                      struct fw_iso_packet *packet,
 150                      struct fw_iso_buffer *buffer,
 151                      unsigned long payload)
 152 {
 153         struct fw_card *card = ctx->card;
 154
 155         return card->driver->queue_iso(ctx, packet, buffer, payload);
 156 }
 157 EXPORT_SYMBOL(fw_iso_context_queue);