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->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
	}

A
Al Viro 已提交
725 726 727
	p = (struct fw_cdev_iso_packet __user *)u64_to_uptr(request->packets);

	if (!access_ok(VERIFY_READ, p, request->size))
728 729
		return -EFAULT;

730
	end = (void __user *)p + request->size;
731 732
	count = 0;
	while (p < end) {
733
		if (get_user(control, &p->control))
734
			return -EFAULT;
735 736 737 738 739 740
		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);
741

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

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

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

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

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

	return count;
}

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

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

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

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

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

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

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

815 816 817 818 819 820 821 822 823 824 825 826 827 828 829
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,
};

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

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

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

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

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;
882 883 884 885 886 887 888 889 890 891
	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;
892

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

	client->vm_start = vma->vm_start;
897 898 899 900 901 902 903 904 905 906 907 908 909 910
	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;
911

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

	return retval;
917 918 919 920 921
}

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

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

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

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

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

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

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

947 948 949 950 951 952 953 954 955
	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;
956
	unsigned int mask = 0;
957 958 959

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

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

	return mask;
966 967
}

968
const struct file_operations fw_device_ops = {
969 970 971 972 973 974 975 976 977
	.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
978
	.compat_ioctl	= fw_device_op_compat_ioctl,
979 980
#endif
};