fw-cdev.c 23.6 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);
}

368
static ssize_t 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
static int ioctl_queue_iso(struct client *client, void *buffer)
681
{
682
	struct fw_cdev_queue_iso *request = buffer;
683
	struct fw_cdev_iso_packet __user *p, *end, *next;
684
	struct fw_iso_context *ctx = client->iso_context;
685
	unsigned long payload, buffer_end, header_length;
686 687 688 689 690 691
	int count;
	struct {
		struct fw_iso_packet packet;
		u8 header[256];
	} u;

692
	if (ctx == NULL || request->handle != 0)
693 694
		return -EINVAL;

695 696
	/*
	 * If the user passes a non-NULL data pointer, has mmap()'ed
697 698
	 * the iso buffer, and the pointer points inside the buffer,
	 * we setup the payload pointers accordingly.  Otherwise we
699
	 * set them both to 0, which will still let packets with
700 701
	 * payload_length == 0 through.  In other words, if no packets
	 * use the indirect payload, the iso buffer need not be mapped
702 703
	 * and the request->data pointer is ignored.
	 */
704

705
	payload = (unsigned long)request->data - client->vm_start;
706
	buffer_end = client->buffer.page_count << PAGE_SHIFT;
707
	if (request->data == 0 || client->buffer.pages == NULL ||
708
	    payload >= buffer_end) {
709
		payload = 0;
710
		buffer_end = 0;
711 712
	}

713
	if (!access_ok(VERIFY_READ, request->packets, request->size))
714 715
		return -EFAULT;

716 717
	p = (struct fw_cdev_iso_packet __user *)u64_to_uptr(request->packets);
	end = (void __user *)p + request->size;
718 719
	count = 0;
	while (p < end) {
720
		if (__copy_from_user(&u.packet, p, sizeof(*p)))
721
			return -EFAULT;
722

723
		if (ctx->type == FW_ISO_CONTEXT_TRANSMIT) {
724 725
			header_length = u.packet.header_length;
		} else {
726 727 728 729
			/*
			 * We require that header_length is a multiple of
			 * the fixed header size, ctx->header_size.
			 */
730 731 732 733
			if (ctx->header_size == 0) {
				if (u.packet.header_length > 0)
					return -EINVAL;
			} else if (u.packet.header_length % ctx->header_size != 0) {
734
				return -EINVAL;
735
			}
736 737 738
			header_length = 0;
		}

739
		next = (struct fw_cdev_iso_packet __user *)
740
			&p->header[header_length / 4];
741 742 743
		if (next > end)
			return -EINVAL;
		if (__copy_from_user
744
		    (u.packet.header, p->header, header_length))
745
			return -EFAULT;
746
		if (u.packet.skip && ctx->type == FW_ISO_CONTEXT_TRANSMIT &&
747 748
		    u.packet.header_length + u.packet.payload_length > 0)
			return -EINVAL;
749
		if (payload + u.packet.payload_length > buffer_end)
750 751
			return -EINVAL;

752 753
		if (fw_iso_context_queue(ctx, &u.packet,
					 &client->buffer, payload))
754 755 756 757 758 759 760
			break;

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

761 762 763
	request->size    -= uptr_to_u64(p) - request->packets;
	request->packets  = uptr_to_u64(p);
	request->data     = client->vm_start + payload;
764 765 766 767

	return count;
}

768
static int ioctl_start_iso(struct client *client, void *buffer)
769
{
770
	struct fw_cdev_start_iso *request = buffer;
771

772 773
	if (request->handle != 0)
		return -EINVAL;
774
	if (client->iso_context->type == FW_ISO_CONTEXT_RECEIVE) {
775
		if (request->tags == 0 || request->tags > 15)
776 777
			return -EINVAL;

778
		if (request->sync > 15)
779 780 781
			return -EINVAL;
	}

782 783
	return fw_iso_context_start(client->iso_context, request->cycle,
				    request->sync, request->tags);
784 785
}

786
static int ioctl_stop_iso(struct client *client, void *buffer)
787
{
788 789 790 791 792
	struct fw_cdev_stop_iso *request = buffer;

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

793 794 795
	return fw_iso_context_stop(client->iso_context);
}

796 797 798 799 800 801 802 803 804 805 806 807 808 809 810
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,
};

811 812 813
static int
dispatch_ioctl(struct client *client, unsigned int cmd, void __user *arg)
{
814 815 816 817 818
	char buffer[256];
	int retval;

	if (_IOC_TYPE(cmd) != '#' ||
	    _IOC_NR(cmd) >= ARRAY_SIZE(ioctl_handlers))
819
		return -EINVAL;
820 821

	if (_IOC_DIR(cmd) & _IOC_WRITE) {
822
		if (_IOC_SIZE(cmd) > sizeof(buffer) ||
823 824 825 826 827 828 829 830 831
		    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) {
832
		if (_IOC_SIZE(cmd) > sizeof(buffer) ||
833 834
		    copy_to_user(arg, buffer, _IOC_SIZE(cmd)))
			return -EFAULT;
835
	}
836 837

	return 0;
838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862
}

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;
863 864 865 866 867 868 869 870 871 872
	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;
873

874
	if (vma->vm_start & ~PAGE_MASK)
875 876 877
		return -EINVAL;

	client->vm_start = vma->vm_start;
878 879 880 881 882 883 884 885 886 887 888 889 890 891
	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;
892

893 894 895 896 897
	retval = fw_iso_buffer_map(&client->buffer, vma);
	if (retval < 0)
		fw_iso_buffer_destroy(&client->buffer, client->device->card);

	return retval;
898 899 900 901 902
}

static int fw_device_op_release(struct inode *inode, struct file *file)
{
	struct client *client = file->private_data;
903
	struct event *e, *next_e;
904
	struct client_resource *r, *next_r;
905
	unsigned long flags;
906

907 908 909
	if (client->buffer.pages)
		fw_iso_buffer_destroy(&client->buffer, client->device->card);

910 911 912
	if (client->iso_context)
		fw_iso_context_destroy(client->iso_context);

913 914
	list_for_each_entry_safe(r, next_r, &client->resource_list, link)
		r->release(client, r);
915

916 917 918 919
	/*
	 * FIXME: We should wait for the async tasklets to stop
	 * running before freeing the memory.
	 */
920

921 922
	list_for_each_entry_safe(e, next_e, &client->event_list, link)
		kfree(e);
923

924 925 926 927
	spin_lock_irqsave(&client->device->card->lock, flags);
	list_del(&client->link);
	spin_unlock_irqrestore(&client->device->card->lock, flags);

928 929 930 931 932 933 934 935 936
	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;
937
	unsigned int mask = 0;
938 939 940

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

941 942
	if (fw_device_is_shutdown(client->device))
		mask |= POLLHUP | POLLERR;
943
	if (!list_empty(&client->event_list))
944 945 946
		mask |= POLLIN | POLLRDNORM;

	return mask;
947 948
}

949
const struct file_operations fw_device_ops = {
950 951 952 953 954 955 956 957 958
	.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
959
	.compat_ioctl	= fw_device_op_compat_ioctl,
960 961
#endif
};