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

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

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

652 653 654
		break;

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

		break;

	default:
661
		return -EINVAL;
662 663
	}

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

674 675 676
	/* We only support one context at this time. */
	request->handle = 0;

677 678 679
	return 0;
}

680 681 682 683 684 685 686 687
/* 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)

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

701
	if (ctx == NULL || request->handle != 0)
702 703
		return -EINVAL;

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

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

722
	if (!access_ok(VERIFY_READ, request->packets, request->size))
723 724
		return -EFAULT;

725 726
	p = (struct fw_cdev_iso_packet __user *)u64_to_uptr(request->packets);
	end = (void __user *)p + request->size;
727 728
	count = 0;
	while (p < end) {
729
		if (get_user(control, &p->control))
730
			return -EFAULT;
731 732 733 734 735 736
		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);
737

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

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

767 768
		if (fw_iso_context_queue(ctx, &u.packet,
					 &client->buffer, payload))
769 770 771 772 773 774 775
			break;

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

776 777 778
	request->size    -= uptr_to_u64(p) - request->packets;
	request->packets  = uptr_to_u64(p);
	request->data     = client->vm_start + payload;
779 780 781 782

	return count;
}

783
static int ioctl_start_iso(struct client *client, void *buffer)
784
{
785
	struct fw_cdev_start_iso *request = buffer;
786

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

793
		if (request->sync > 15)
794 795 796
			return -EINVAL;
	}

797 798
	return fw_iso_context_start(client->iso_context, request->cycle,
				    request->sync, request->tags);
799 800
}

801
static int ioctl_stop_iso(struct client *client, void *buffer)
802
{
803 804 805 806 807
	struct fw_cdev_stop_iso *request = buffer;

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

808 809 810
	return fw_iso_context_stop(client->iso_context);
}

811 812 813 814 815 816 817 818 819 820 821 822 823 824 825
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,
};

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

	if (_IOC_TYPE(cmd) != '#' ||
	    _IOC_NR(cmd) >= ARRAY_SIZE(ioctl_handlers))
834
		return -EINVAL;
835 836

	if (_IOC_DIR(cmd) & _IOC_WRITE) {
837
		if (_IOC_SIZE(cmd) > sizeof(buffer) ||
838 839 840 841 842 843 844 845 846
		    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) {
847
		if (_IOC_SIZE(cmd) > sizeof(buffer) ||
848 849
		    copy_to_user(arg, buffer, _IOC_SIZE(cmd)))
			return -EFAULT;
850
	}
851 852

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

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;
878 879 880 881 882 883 884 885 886 887
	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;
888

889
	if (vma->vm_start & ~PAGE_MASK)
890 891 892
		return -EINVAL;

	client->vm_start = vma->vm_start;
893 894 895 896 897 898 899 900 901 902 903 904 905 906
	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;
907

908 909 910 911 912
	retval = fw_iso_buffer_map(&client->buffer, vma);
	if (retval < 0)
		fw_iso_buffer_destroy(&client->buffer, client->device->card);

	return retval;
913 914 915 916 917
}

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

922 923 924
	if (client->buffer.pages)
		fw_iso_buffer_destroy(&client->buffer, client->device->card);

925 926 927
	if (client->iso_context)
		fw_iso_context_destroy(client->iso_context);

928 929
	list_for_each_entry_safe(r, next_r, &client->resource_list, link)
		r->release(client, r);
930

931 932 933 934
	/*
	 * FIXME: We should wait for the async tasklets to stop
	 * running before freeing the memory.
	 */
935

936 937
	list_for_each_entry_safe(e, next_e, &client->event_list, link)
		kfree(e);
938

939 940 941 942
	spin_lock_irqsave(&client->device->card->lock, flags);
	list_del(&client->link);
	spin_unlock_irqrestore(&client->device->card->lock, flags);

943 944 945 946 947 948 949 950 951
	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;
952
	unsigned int mask = 0;
953 954 955

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

956 957
	if (fw_device_is_shutdown(client->device))
		mask |= POLLHUP | POLLERR;
958
	if (!list_empty(&client->event_list))
959 960 961
		mask |= POLLIN | POLLRDNORM;

	return mask;
962 963
}

964
const struct file_operations fw_device_ops = {
965 966 967 968 969 970 971 972 973
	.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
974
	.compat_ioctl	= fw_device_op_compat_ioctl,
975 976
#endif
};