summaryrefslogtreecommitdiff
path: root/drivers/firewire/fw-iso.c
blob: 6481e3df2c93197c362660c1e812bab028477345 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
/*						-*- c-basic-offset: 8 -*-
 *
 * fw-iso.c - Isochronous IO
 * Copyright (C) 2006 Kristian Hoegsberg <krh@bitplanet.net>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software Foundation,
 * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/dma-mapping.h>
#include <linux/vmalloc.h>
#include <linux/mm.h>

#include "fw-transaction.h"
#include "fw-topology.h"
#include "fw-device.h"

static int
setup_iso_buffer(struct fw_iso_context *ctx, size_t size,
		 enum dma_data_direction direction)
{
	struct page *page;
	int i, j;
	void *p;

	ctx->buffer_size = PAGE_ALIGN(size);
	if (size == 0)
		return 0;

	ctx->buffer = vmalloc_32_user(ctx->buffer_size);
	if (ctx->buffer == NULL)
		goto fail_buffer_alloc;

	ctx->page_count = ctx->buffer_size >> PAGE_SHIFT;
	ctx->pages =
	    kzalloc(ctx->page_count * sizeof(ctx->pages[0]), GFP_KERNEL);
	if (ctx->pages == NULL)
		goto fail_pages_alloc;

	p = ctx->buffer;
	for (i = 0; i < ctx->page_count; i++, p += PAGE_SIZE) {
		page = vmalloc_to_page(p);
		ctx->pages[i] = dma_map_page(ctx->card->device,
					     page, 0, PAGE_SIZE, direction);
		if (dma_mapping_error(ctx->pages[i]))
			goto fail_mapping;
	}

	return 0;

 fail_mapping:
	for (j = 0; j < i; j++)
		dma_unmap_page(ctx->card->device, ctx->pages[j],
			       PAGE_SIZE, DMA_TO_DEVICE);
 fail_pages_alloc:
	vfree(ctx->buffer);
 fail_buffer_alloc:
	return -ENOMEM;
}

static void destroy_iso_buffer(struct fw_iso_context *ctx)
{
	int i;

	for (i = 0; i < ctx->page_count; i++)
		dma_unmap_page(ctx->card->device, ctx->pages[i],
			       PAGE_SIZE, DMA_TO_DEVICE);

	kfree(ctx->pages);
	vfree(ctx->buffer);
}

struct fw_iso_context *fw_iso_context_create(struct fw_card *card, int type,
					     size_t buffer_size,
					     fw_iso_callback_t callback,
					     void *callback_data)
{
	struct fw_iso_context *ctx;
	int retval;

	ctx = card->driver->allocate_iso_context(card, type);
	if (IS_ERR(ctx))
		return ctx;

	ctx->card = card;
	ctx->type = type;
	ctx->callback = callback;
	ctx->callback_data = callback_data;

	retval = setup_iso_buffer(ctx, buffer_size, DMA_TO_DEVICE);
	if (retval < 0) {
		card->driver->free_iso_context(ctx);
		return ERR_PTR(retval);
	}

	return ctx;
}
EXPORT_SYMBOL(fw_iso_context_create);

void fw_iso_context_destroy(struct fw_iso_context *ctx)
{
	struct fw_card *card = ctx->card;

	destroy_iso_buffer(ctx);

	card->driver->free_iso_context(ctx);
}
EXPORT_SYMBOL(fw_iso_context_destroy);

int
fw_iso_context_send(struct fw_iso_context *ctx,
		    int channel, int speed, int cycle)
{
	ctx->channel = channel;
	ctx->speed = speed;

	return ctx->card->driver->send_iso(ctx, cycle);
}
EXPORT_SYMBOL(fw_iso_context_send);

int
fw_iso_context_queue(struct fw_iso_context *ctx,
		     struct fw_iso_packet *packet, void *payload)
{
	struct fw_card *card = ctx->card;

	return card->driver->queue_iso(ctx, packet, payload);
}
EXPORT_SYMBOL(fw_iso_context_queue);