fw-cdev.c 24.2 KB
Newer Older
1 2
/*
 * Char device for device raw access
3
 *
4
 * Copyright (C) 2005-2007  Kristian Hoegsberg <krh@bitplanet.net>
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
 *
 * 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/module.h>
#include <linux/kernel.h>
#include <linux/wait.h>
#include <linux/errno.h>
#include <linux/device.h>
#include <linux/vmalloc.h>
#include <linux/poll.h>
#include <linux/delay.h>
#include <linux/mm.h>
30
#include <linux/idr.h>
31
#include <linux/compat.h>
32
#include <linux/firewire-cdev.h>
33 34 35 36 37
#include <asm/uaccess.h>
#include "fw-transaction.h"
#include "fw-topology.h"
#include "fw-device.h"

38 39 40 41 42 43 44
struct client;
struct client_resource {
	struct list_head link;
	void (*release)(struct client *client, struct client_resource *r);
	u32 handle;
};

45 46 47 48 49
/*
 * dequeue_event() just kfree()'s the event, so the event has to be
 * the first field in the struct.
 */

50 51 52 53 54
struct event {
	struct { void *data; size_t size; } v[2];
	struct list_head link;
};

55 56 57 58 59
struct bus_reset {
	struct event event;
	struct fw_cdev_event_bus_reset reset;
};

60 61 62 63
struct response {
	struct event event;
	struct fw_transaction transaction;
	struct client *client;
64
	struct client_resource resource;
65 66 67 68 69 70 71 72 73
	struct fw_cdev_event_response response;
};

struct iso_interrupt {
	struct event event;
	struct fw_cdev_event_iso_interrupt interrupt;
};

struct client {
74
	u32 version;
75 76
	struct fw_device *device;
	spinlock_t lock;
77
	u32 resource_handle;
78
	struct list_head resource_list;
79 80
	struct list_head event_list;
	wait_queue_head_t wait;
81
	u64 bus_reset_closure;
82

83
	struct fw_iso_context *iso_context;
84
	u64 iso_closure;
85 86
	struct fw_iso_buffer buffer;
	unsigned long vm_start;
87 88

	struct list_head link;
89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106
};

static inline void __user *
u64_to_uptr(__u64 value)
{
	return (void __user *)(unsigned long)value;
}

static inline __u64
uptr_to_u64(void __user *ptr)
{
	return (__u64)(unsigned long)ptr;
}

static int fw_device_op_open(struct inode *inode, struct file *file)
{
	struct fw_device *device;
	struct client *client;
107
	unsigned long flags;
108

109 110 111
	device = fw_device_from_devt(inode->i_rdev);
	if (device == NULL)
		return -ENODEV;
112

113
	client = kzalloc(sizeof(*client), GFP_KERNEL);
114 115 116 117 118
	if (client == NULL)
		return -ENOMEM;

	client->device = fw_device_get(device);
	INIT_LIST_HEAD(&client->event_list);
119
	INIT_LIST_HEAD(&client->resource_list);
120 121 122 123 124
	spin_lock_init(&client->lock);
	init_waitqueue_head(&client->wait);

	file->private_data = client;

125 126 127 128
	spin_lock_irqsave(&device->card->lock, flags);
	list_add_tail(&client->link, &device->client_list);
	spin_unlock_irqrestore(&device->card->lock, flags);

129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149
	return 0;
}

static void queue_event(struct client *client, struct event *event,
			void *data0, size_t size0, void *data1, size_t size1)
{
	unsigned long flags;

	event->v[0].data = data0;
	event->v[0].size = size0;
	event->v[1].data = data1;
	event->v[1].size = size1;

	spin_lock_irqsave(&client->lock, flags);

	list_add_tail(&event->link, &client->event_list);
	wake_up_interruptible(&client->wait);

	spin_unlock_irqrestore(&client->lock, flags);
}

150 151
static int
dequeue_event(struct client *client, char __user *buffer, size_t count)
152 153 154 155
{
	unsigned long flags;
	struct event *event;
	size_t size, total;
156
	int i, retval;
157

158 159 160 161 162
	retval = wait_event_interruptible(client->wait,
					  !list_empty(&client->event_list) ||
					  fw_device_is_shutdown(client->device));
	if (retval < 0)
		return retval;
163

164 165 166
	if (list_empty(&client->event_list) &&
		       fw_device_is_shutdown(client->device))
		return -ENODEV;
167

168
	spin_lock_irqsave(&client->lock, flags);
169 170 171 172 173 174 175
	event = container_of(client->event_list.next, struct event, link);
	list_del(&event->link);
	spin_unlock_irqrestore(&client->lock, flags);

	total = 0;
	for (i = 0; i < ARRAY_SIZE(event->v) && total < count; i++) {
		size = min(event->v[i].size, count - total);
176 177
		if (copy_to_user(buffer + total, event->v[i].data, size)) {
			retval = -EFAULT;
178
			goto out;
179
		}
180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198
		total += size;
	}
	retval = total;

 out:
	kfree(event);

	return retval;
}

static ssize_t
fw_device_op_read(struct file *file,
		  char __user *buffer, size_t count, loff_t *offset)
{
	struct client *client = file->private_data;

	return dequeue_event(client, buffer, count);
}

199 200
static void
fill_bus_reset_event(struct fw_cdev_event_bus_reset *event,
201
		     struct client *client)
202
{
203
	struct fw_card *card = client->device->card;
204

205
	event->closure	     = client->bus_reset_closure;
206
	event->type          = FW_CDEV_EVENT_BUS_RESET;
207
	event->node_id       = client->device->node_id;
208 209 210 211 212 213 214
	event->local_node_id = card->local_node->node_id;
	event->bm_node_id    = 0; /* FIXME: We don't track the BM. */
	event->irm_node_id   = card->irm_node->node_id;
	event->root_node_id  = card->root_node->node_id;
	event->generation    = card->generation;
}

215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230
static void
for_each_client(struct fw_device *device,
		void (*callback)(struct client *client))
{
	struct fw_card *card = device->card;
	struct client *c;
	unsigned long flags;

	spin_lock_irqsave(&card->lock, flags);

	list_for_each_entry(c, &device->client_list, link)
		callback(c);

	spin_unlock_irqrestore(&card->lock, flags);
}

231 232 233 234 235
static void
queue_bus_reset_event(struct client *client)
{
	struct bus_reset *bus_reset;

236
	bus_reset = kzalloc(sizeof(*bus_reset), GFP_ATOMIC);
237 238 239 240 241
	if (bus_reset == NULL) {
		fw_notify("Out of memory when allocating bus reset event\n");
		return;
	}

242
	fill_bus_reset_event(&bus_reset->reset, client);
243 244

	queue_event(client, &bus_reset->event,
245
		    &bus_reset->reset, sizeof(bus_reset->reset), NULL, 0);
246 247 248 249
}

void fw_device_cdev_update(struct fw_device *device)
{
250 251
	for_each_client(device, queue_bus_reset_event);
}
252

253 254 255 256
static void wake_up_client(struct client *client)
{
	wake_up_interruptible(&client->wait);
}
257

258 259 260
void fw_device_cdev_remove(struct fw_device *device)
{
	for_each_client(device, wake_up_client);
261 262
}

263
static int ioctl_get_info(struct client *client, void *buffer)
264
{
265
	struct fw_cdev_get_info *get_info = buffer;
266 267
	struct fw_cdev_event_bus_reset bus_reset;

268 269
	client->version = get_info->version;
	get_info->version = FW_CDEV_VERSION;
270

271 272 273
	if (get_info->rom != 0) {
		void __user *uptr = u64_to_uptr(get_info->rom);
		size_t want = get_info->rom_length;
274
		size_t have = client->device->config_rom_length * 4;
275

276 277
		if (copy_to_user(uptr, client->device->config_rom,
				 min(want, have)))
278 279
			return -EFAULT;
	}
280
	get_info->rom_length = client->device->config_rom_length * 4;
281

282 283 284
	client->bus_reset_closure = get_info->bus_reset_closure;
	if (get_info->bus_reset != 0) {
		void __user *uptr = u64_to_uptr(get_info->bus_reset);
285

286
		fill_bus_reset_event(&bus_reset, client);
287
		if (copy_to_user(uptr, &bus_reset, sizeof(bus_reset)))
288 289
			return -EFAULT;
	}
290

291
	get_info->card = client->device->card->index;
292 293 294 295

	return 0;
}

296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342
static void
add_client_resource(struct client *client, struct client_resource *resource)
{
	unsigned long flags;

	spin_lock_irqsave(&client->lock, flags);
	list_add_tail(&resource->link, &client->resource_list);
	resource->handle = client->resource_handle++;
	spin_unlock_irqrestore(&client->lock, flags);
}

static int
release_client_resource(struct client *client, u32 handle,
			struct client_resource **resource)
{
	struct client_resource *r;
	unsigned long flags;

	spin_lock_irqsave(&client->lock, flags);
	list_for_each_entry(r, &client->resource_list, link) {
		if (r->handle == handle) {
			list_del(&r->link);
			break;
		}
	}
	spin_unlock_irqrestore(&client->lock, flags);

	if (&r->link == &client->resource_list)
		return -EINVAL;

	if (resource)
		*resource = r;
	else
		r->release(client, r);

	return 0;
}

static void
release_transaction(struct client *client, struct client_resource *resource)
{
	struct response *response =
		container_of(resource, struct response, resource);

	fw_cancel_transaction(client->device->card, &response->transaction);
}

343 344 345 346 347 348
static void
complete_transaction(struct fw_card *card, int rcode,
		     void *payload, size_t length, void *data)
{
	struct response *response = data;
	struct client *client = response->client;
349
	unsigned long flags;
350 351 352 353 354 355 356

	if (length < response->response.length)
		response->response.length = length;
	if (rcode == RCODE_COMPLETE)
		memcpy(response->response.data, payload,
		       response->response.length);

357
	spin_lock_irqsave(&client->lock, flags);
358
	list_del(&response->resource.link);
359 360
	spin_unlock_irqrestore(&client->lock, flags);

361 362 363
	response->response.type   = FW_CDEV_EVENT_RESPONSE;
	response->response.rcode  = rcode;
	queue_event(client, &response->event,
364
		    &response->response, sizeof(response->response),
365 366 367
		    response->response.data, response->response.length);
}

J
Jeff Garzik 已提交
368
static int ioctl_send_request(struct client *client, void *buffer)
369 370
{
	struct fw_device *device = client->device;
371
	struct fw_cdev_send_request *request = buffer;
372 373 374
	struct response *response;

	/* What is the biggest size we'll accept, really? */
375
	if (request->length > 4096)
376 377
		return -EINVAL;

378
	response = kmalloc(sizeof(*response) + request->length, GFP_KERNEL);
379 380 381 382
	if (response == NULL)
		return -ENOMEM;

	response->client = client;
383 384
	response->response.length = request->length;
	response->response.closure = request->closure;
385

386
	if (request->data &&
387
	    copy_from_user(response->response.data,
388
			   u64_to_uptr(request->data), request->length)) {
389 390 391 392
		kfree(response);
		return -EFAULT;
	}

393 394
	response->resource.release = release_transaction;
	add_client_resource(client, &response->resource);
395

396
	fw_send_request(device->card, &response->transaction,
397
			request->tcode & 0x1f,
398
			device->node->node_id,
399
			request->generation,
400
			device->node->max_speed,
401 402
			request->offset,
			response->response.data, request->length,
403 404
			complete_transaction, response);

405
	if (request->data)
406
		return sizeof(request) + request->length;
407
	else
408
		return sizeof(request);
409 410 411 412 413 414
}

struct address_handler {
	struct fw_address_handler handler;
	__u64 closure;
	struct client *client;
415
	struct client_resource resource;
416 417 418 419 420 421
};

struct request {
	struct fw_request *request;
	void *data;
	size_t length;
422
	struct client_resource resource;
423 424 425 426 427 428 429
};

struct request_event {
	struct event event;
	struct fw_cdev_event_request request;
};

430 431 432 433 434 435 436 437 438 439 440
static void
release_request(struct client *client, struct client_resource *resource)
{
	struct request *request =
		container_of(resource, struct request, resource);

	fw_send_response(client->device->card, request->request,
			 RCODE_CONFLICT_ERROR);
	kfree(request);
}

441 442 443 444 445 446 447 448 449 450 451 452
static void
handle_request(struct fw_card *card, struct fw_request *r,
	       int tcode, int destination, int source,
	       int generation, int speed,
	       unsigned long long offset,
	       void *payload, size_t length, void *callback_data)
{
	struct address_handler *handler = callback_data;
	struct request *request;
	struct request_event *e;
	struct client *client = handler->client;

453 454
	request = kmalloc(sizeof(*request), GFP_ATOMIC);
	e = kmalloc(sizeof(*e), GFP_ATOMIC);
455 456 457 458 459 460 461 462 463 464 465
	if (request == NULL || e == NULL) {
		kfree(request);
		kfree(e);
		fw_send_response(card, r, RCODE_CONFLICT_ERROR);
		return;
	}

	request->request = r;
	request->data    = payload;
	request->length  = length;

466 467
	request->resource.release = release_request;
	add_client_resource(client, &request->resource);
468 469 470 471 472

	e->request.type    = FW_CDEV_EVENT_REQUEST;
	e->request.tcode   = tcode;
	e->request.offset  = offset;
	e->request.length  = length;
473
	e->request.handle  = request->resource.handle;
474 475 476
	e->request.closure = handler->closure;

	queue_event(client, &e->event,
477
		    &e->request, sizeof(e->request), payload, length);
478 479
}

480 481 482 483 484 485 486 487 488 489 490
static void
release_address_handler(struct client *client,
			struct client_resource *resource)
{
	struct address_handler *handler =
		container_of(resource, struct address_handler, resource);

	fw_core_remove_address_handler(&handler->handler);
	kfree(handler);
}

491
static int ioctl_allocate(struct client *client, void *buffer)
492
{
493
	struct fw_cdev_allocate *request = buffer;
494 495 496
	struct address_handler *handler;
	struct fw_address_region region;

497
	handler = kmalloc(sizeof(*handler), GFP_KERNEL);
498 499 500
	if (handler == NULL)
		return -ENOMEM;

501 502 503
	region.start = request->offset;
	region.end = request->offset + request->length;
	handler->handler.length = request->length;
504 505
	handler->handler.address_callback = handle_request;
	handler->handler.callback_data = handler;
506
	handler->closure = request->closure;
507 508 509 510 511 512 513
	handler->client = client;

	if (fw_core_add_address_handler(&handler->handler, &region) < 0) {
		kfree(handler);
		return -EBUSY;
	}

514 515
	handler->resource.release = release_address_handler;
	add_client_resource(client, &handler->resource);
516
	request->handle = handler->resource.handle;
517 518 519 520

	return 0;
}

521
static int ioctl_deallocate(struct client *client, void *buffer)
522
{
523
	struct fw_cdev_deallocate *request = buffer;
524

525
	return release_client_resource(client, request->handle, NULL);
526 527
}

528
static int ioctl_send_response(struct client *client, void *buffer)
529
{
530
	struct fw_cdev_send_response *request = buffer;
531
	struct client_resource *resource;
532 533
	struct request *r;

534
	if (release_client_resource(client, request->handle, &resource) < 0)
535
		return -EINVAL;
536
	r = container_of(resource, struct request, resource);
537 538 539
	if (request->length < r->length)
		r->length = request->length;
	if (copy_from_user(r->data, u64_to_uptr(request->data), r->length))
540 541
		return -EFAULT;

542
	fw_send_response(client->device->card, r->request, request->rcode);
543 544 545 546 547
	kfree(r);

	return 0;
}

548
static int ioctl_initiate_bus_reset(struct client *client, void *buffer)
549
{
550
	struct fw_cdev_initiate_bus_reset *request = buffer;
551 552
	int short_reset;

553
	short_reset = (request->type == FW_CDEV_SHORT_RESET);
554 555 556 557

	return fw_core_initiate_bus_reset(client->device->card, short_reset);
}

558 559
struct descriptor {
	struct fw_descriptor d;
560
	struct client_resource resource;
561 562 563
	u32 data[0];
};

564 565 566 567 568 569 570 571 572 573
static void release_descriptor(struct client *client,
			       struct client_resource *resource)
{
	struct descriptor *descriptor =
		container_of(resource, struct descriptor, resource);

	fw_core_remove_descriptor(&descriptor->d);
	kfree(descriptor);
}

574
static int ioctl_add_descriptor(struct client *client, void *buffer)
575
{
576
	struct fw_cdev_add_descriptor *request = buffer;
577 578 579
	struct descriptor *descriptor;
	int retval;

580
	if (request->length > 256)
581 582 583
		return -EINVAL;

	descriptor =
584
		kmalloc(sizeof(*descriptor) + request->length * 4, GFP_KERNEL);
585 586 587 588
	if (descriptor == NULL)
		return -ENOMEM;

	if (copy_from_user(descriptor->data,
589
			   u64_to_uptr(request->data), request->length * 4)) {
590 591 592 593
		kfree(descriptor);
		return -EFAULT;
	}

594 595 596
	descriptor->d.length = request->length;
	descriptor->d.immediate = request->immediate;
	descriptor->d.key = request->key;
597 598 599 600 601 602 603 604
	descriptor->d.data = descriptor->data;

	retval = fw_core_add_descriptor(&descriptor->d);
	if (retval < 0) {
		kfree(descriptor);
		return retval;
	}

605 606
	descriptor->resource.release = release_descriptor;
	add_client_resource(client, &descriptor->resource);
607
	request->handle = descriptor->resource.handle;
608 609 610 611

	return 0;
}

612
static int ioctl_remove_descriptor(struct client *client, void *buffer)
613
{
614
	struct fw_cdev_remove_descriptor *request = buffer;
615

616
	return release_client_resource(client, request->handle, NULL);
617 618
}

619
static void
620 621
iso_callback(struct fw_iso_context *context, u32 cycle,
	     size_t header_length, void *header, void *data)
622 623 624 625
{
	struct client *client = data;
	struct iso_interrupt *interrupt;

626
	interrupt = kzalloc(sizeof(*interrupt) + header_length, GFP_ATOMIC);
627 628 629 630
	if (interrupt == NULL)
		return;

	interrupt->interrupt.type      = FW_CDEV_EVENT_ISO_INTERRUPT;
631
	interrupt->interrupt.closure   = client->iso_closure;
632
	interrupt->interrupt.cycle     = cycle;
633 634
	interrupt->interrupt.header_length = header_length;
	memcpy(interrupt->interrupt.header, header, header_length);
635
	queue_event(client, &interrupt->event,
636
		    &interrupt->interrupt,
637
		    sizeof(interrupt->interrupt) + header_length, NULL, 0);
638 639
}

640
static int ioctl_create_iso_context(struct client *client, void *buffer)
641
{
642
	struct fw_cdev_create_iso_context *request = buffer;
643
	struct fw_iso_context *context;
644

645
	if (request->channel > 63)
646 647
		return -EINVAL;

648
	switch (request->type) {
649
	case FW_ISO_CONTEXT_RECEIVE:
650
		if (request->header_size < 4 || (request->header_size & 3))
651
			return -EINVAL;
652

653 654 655
		break;

	case FW_ISO_CONTEXT_TRANSMIT:
656
		if (request->speed > SCODE_3200)
657 658 659 660 661
			return -EINVAL;

		break;

	default:
662
		return -EINVAL;
663 664
	}

665 666 667 668 669 670 671 672 673
	context =  fw_iso_context_create(client->device->card,
					 request->type,
					 request->channel,
					 request->speed,
					 request->header_size,
					 iso_callback, client);
	if (IS_ERR(context))
		return PTR_ERR(context);

674
	client->iso_closure = request->closure;
675
	client->iso_context = context;
676

677 678 679
	/* We only support one context at this time. */
	request->handle = 0;

680 681 682
	return 0;
}

683 684 685 686 687 688 689 690
/* Macros for decoding the iso packet control header. */
#define GET_PAYLOAD_LENGTH(v)	((v) & 0xffff)
#define GET_INTERRUPT(v)	(((v) >> 16) & 0x01)
#define GET_SKIP(v)		(((v) >> 17) & 0x01)
#define GET_TAG(v)		(((v) >> 18) & 0x02)
#define GET_SY(v)		(((v) >> 20) & 0x04)
#define GET_HEADER_LENGTH(v)	(((v) >> 24) & 0xff)

691
static int ioctl_queue_iso(struct client *client, void *buffer)
692
{
693
	struct fw_cdev_queue_iso *request = buffer;
694
	struct fw_cdev_iso_packet __user *p, *end, *next;
695
	struct fw_iso_context *ctx = client->iso_context;
696
	unsigned long payload, buffer_end, header_length;
697
	u32 control;
698 699 700 701 702 703
	int count;
	struct {
		struct fw_iso_packet packet;
		u8 header[256];
	} u;

704
	if (ctx == NULL || request->handle != 0)
705 706
		return -EINVAL;

707 708
	/*
	 * If the user passes a non-NULL data pointer, has mmap()'ed
709 710
	 * the iso buffer, and the pointer points inside the buffer,
	 * we setup the payload pointers accordingly.  Otherwise we
711
	 * set them both to 0, which will still let packets with
712 713
	 * payload_length == 0 through.  In other words, if no packets
	 * use the indirect payload, the iso buffer need not be mapped
714 715
	 * and the request->data pointer is ignored.
	 */
716

717
	payload = (unsigned long)request->data - client->vm_start;
718
	buffer_end = client->buffer.page_count << PAGE_SHIFT;
719
	if (request->data == 0 || client->buffer.pages == NULL ||
720
	    payload >= buffer_end) {
721
		payload = 0;
722
		buffer_end = 0;
723 724
	}

725
	if (!access_ok(VERIFY_READ, request->packets, request->size))
726 727
		return -EFAULT;

728 729
	p = (struct fw_cdev_iso_packet __user *)u64_to_uptr(request->packets);
	end = (void __user *)p + request->size;
730 731
	count = 0;
	while (p < end) {
732
		if (get_user(control, &p->control))
733
			return -EFAULT;
734 735 736 737 738 739
		u.packet.payload_length = GET_PAYLOAD_LENGTH(control);
		u.packet.interrupt = GET_INTERRUPT(control);
		u.packet.skip = GET_SKIP(control);
		u.packet.tag = GET_TAG(control);
		u.packet.sy = GET_SY(control);
		u.packet.header_length = GET_HEADER_LENGTH(control);
740

741
		if (ctx->type == FW_ISO_CONTEXT_TRANSMIT) {
742 743
			header_length = u.packet.header_length;
		} else {
744 745 746 747
			/*
			 * We require that header_length is a multiple of
			 * the fixed header size, ctx->header_size.
			 */
748 749 750 751
			if (ctx->header_size == 0) {
				if (u.packet.header_length > 0)
					return -EINVAL;
			} else if (u.packet.header_length % ctx->header_size != 0) {
752
				return -EINVAL;
753
			}
754 755 756
			header_length = 0;
		}

757
		next = (struct fw_cdev_iso_packet __user *)
758
			&p->header[header_length / 4];
759 760 761
		if (next > end)
			return -EINVAL;
		if (__copy_from_user
762
		    (u.packet.header, p->header, header_length))
763
			return -EFAULT;
764
		if (u.packet.skip && ctx->type == FW_ISO_CONTEXT_TRANSMIT &&
765 766
		    u.packet.header_length + u.packet.payload_length > 0)
			return -EINVAL;
767
		if (payload + u.packet.payload_length > buffer_end)
768 769
			return -EINVAL;

770 771
		if (fw_iso_context_queue(ctx, &u.packet,
					 &client->buffer, payload))
772 773 774 775 776 777 778
			break;

		p = next;
		payload += u.packet.payload_length;
		count++;
	}

779 780 781
	request->size    -= uptr_to_u64(p) - request->packets;
	request->packets  = uptr_to_u64(p);
	request->data     = client->vm_start + payload;
782 783 784 785

	return count;
}

786
static int ioctl_start_iso(struct client *client, void *buffer)
787
{
788
	struct fw_cdev_start_iso *request = buffer;
789

790 791
	if (request->handle != 0)
		return -EINVAL;
792
	if (client->iso_context->type == FW_ISO_CONTEXT_RECEIVE) {
793
		if (request->tags == 0 || request->tags > 15)
794 795
			return -EINVAL;

796
		if (request->sync > 15)
797 798 799
			return -EINVAL;
	}

800 801
	return fw_iso_context_start(client->iso_context, request->cycle,
				    request->sync, request->tags);
802 803
}

804
static int ioctl_stop_iso(struct client *client, void *buffer)
805
{
806 807 808 809 810
	struct fw_cdev_stop_iso *request = buffer;

	if (request->handle != 0)
		return -EINVAL;

811 812 813
	return fw_iso_context_stop(client->iso_context);
}

814 815 816 817 818 819 820 821 822 823 824 825 826 827 828
static int (* const ioctl_handlers[])(struct client *client, void *buffer) = {
	ioctl_get_info,
	ioctl_send_request,
	ioctl_allocate,
	ioctl_deallocate,
	ioctl_send_response,
	ioctl_initiate_bus_reset,
	ioctl_add_descriptor,
	ioctl_remove_descriptor,
	ioctl_create_iso_context,
	ioctl_queue_iso,
	ioctl_start_iso,
	ioctl_stop_iso,
};

829 830 831
static int
dispatch_ioctl(struct client *client, unsigned int cmd, void __user *arg)
{
832 833 834 835 836
	char buffer[256];
	int retval;

	if (_IOC_TYPE(cmd) != '#' ||
	    _IOC_NR(cmd) >= ARRAY_SIZE(ioctl_handlers))
837
		return -EINVAL;
838 839

	if (_IOC_DIR(cmd) & _IOC_WRITE) {
840
		if (_IOC_SIZE(cmd) > sizeof(buffer) ||
841 842 843 844 845 846 847 848 849
		    copy_from_user(buffer, arg, _IOC_SIZE(cmd)))
			return -EFAULT;
	}

	retval = ioctl_handlers[_IOC_NR(cmd)](client, buffer);
	if (retval < 0)
		return retval;

	if (_IOC_DIR(cmd) & _IOC_READ) {
850
		if (_IOC_SIZE(cmd) > sizeof(buffer) ||
851 852
		    copy_to_user(arg, buffer, _IOC_SIZE(cmd)))
			return -EFAULT;
853
	}
854 855

	return 0;
856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880
}

static long
fw_device_op_ioctl(struct file *file,
		   unsigned int cmd, unsigned long arg)
{
	struct client *client = file->private_data;

	return dispatch_ioctl(client, cmd, (void __user *) arg);
}

#ifdef CONFIG_COMPAT
static long
fw_device_op_compat_ioctl(struct file *file,
			  unsigned int cmd, unsigned long arg)
{
	struct client *client = file->private_data;

	return dispatch_ioctl(client, cmd, compat_ptr(arg));
}
#endif

static int fw_device_op_mmap(struct file *file, struct vm_area_struct *vma)
{
	struct client *client = file->private_data;
881 882 883 884 885 886 887 888 889 890
	enum dma_data_direction direction;
	unsigned long size;
	int page_count, retval;

	/* FIXME: We could support multiple buffers, but we don't. */
	if (client->buffer.pages != NULL)
		return -EBUSY;

	if (!(vma->vm_flags & VM_SHARED))
		return -EINVAL;
891

892
	if (vma->vm_start & ~PAGE_MASK)
893 894 895
		return -EINVAL;

	client->vm_start = vma->vm_start;
896 897 898 899 900 901 902 903 904 905 906 907 908 909
	size = vma->vm_end - vma->vm_start;
	page_count = size >> PAGE_SHIFT;
	if (size & ~PAGE_MASK)
		return -EINVAL;

	if (vma->vm_flags & VM_WRITE)
		direction = DMA_TO_DEVICE;
	else
		direction = DMA_FROM_DEVICE;

	retval = fw_iso_buffer_init(&client->buffer, client->device->card,
				    page_count, direction);
	if (retval < 0)
		return retval;
910

911 912 913 914 915
	retval = fw_iso_buffer_map(&client->buffer, vma);
	if (retval < 0)
		fw_iso_buffer_destroy(&client->buffer, client->device->card);

	return retval;
916 917 918 919 920
}

static int fw_device_op_release(struct inode *inode, struct file *file)
{
	struct client *client = file->private_data;
921
	struct event *e, *next_e;
922
	struct client_resource *r, *next_r;
923
	unsigned long flags;
924

925 926 927
	if (client->buffer.pages)
		fw_iso_buffer_destroy(&client->buffer, client->device->card);

928 929 930
	if (client->iso_context)
		fw_iso_context_destroy(client->iso_context);

931 932
	list_for_each_entry_safe(r, next_r, &client->resource_list, link)
		r->release(client, r);
933

934 935 936 937
	/*
	 * FIXME: We should wait for the async tasklets to stop
	 * running before freeing the memory.
	 */
938

939 940
	list_for_each_entry_safe(e, next_e, &client->event_list, link)
		kfree(e);
941

942 943 944 945
	spin_lock_irqsave(&client->device->card->lock, flags);
	list_del(&client->link);
	spin_unlock_irqrestore(&client->device->card->lock, flags);

946 947 948 949 950 951 952 953 954
	fw_device_put(client->device);
	kfree(client);

	return 0;
}

static unsigned int fw_device_op_poll(struct file *file, poll_table * pt)
{
	struct client *client = file->private_data;
955
	unsigned int mask = 0;
956 957 958

	poll_wait(file, &client->wait, pt);

959 960
	if (fw_device_is_shutdown(client->device))
		mask |= POLLHUP | POLLERR;
961
	if (!list_empty(&client->event_list))
962 963 964
		mask |= POLLIN | POLLRDNORM;

	return mask;
965 966
}

967
const struct file_operations fw_device_ops = {
968 969 970 971 972 973 974 975 976
	.owner		= THIS_MODULE,
	.open		= fw_device_op_open,
	.read		= fw_device_op_read,
	.unlocked_ioctl	= fw_device_op_ioctl,
	.poll		= fw_device_op_poll,
	.release	= fw_device_op_release,
	.mmap		= fw_device_op_mmap,

#ifdef CONFIG_COMPAT
977
	.compat_ioctl	= fw_device_op_compat_ioctl,
978 979
#endif
};