Merge branch 'ost' into release
[linux-2.6-block.git] / drivers / firewire / core-cdev.c
CommitLineData
c781c06d
KH
1/*
2 * Char device for device raw access
19a15b93 3 *
c781c06d 4 * Copyright (C) 2005-2007 Kristian Hoegsberg <krh@bitplanet.net>
19a15b93
KH
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software Foundation,
18 * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
19 */
20
be5bbd67
SR
21#include <linux/compat.h>
22#include <linux/delay.h>
23#include <linux/device.h>
24#include <linux/errno.h>
77c9a5da 25#include <linux/firewire.h>
be5bbd67
SR
26#include <linux/firewire-cdev.h>
27#include <linux/idr.h>
b1bda4cd 28#include <linux/jiffies.h>
19a15b93 29#include <linux/kernel.h>
fb443036 30#include <linux/kref.h>
be5bbd67
SR
31#include <linux/mm.h>
32#include <linux/module.h>
d67cfb96 33#include <linux/mutex.h>
19a15b93 34#include <linux/poll.h>
a64408b9 35#include <linux/preempt.h>
a99bbaf5 36#include <linux/sched.h>
cf417e54 37#include <linux/spinlock.h>
be5bbd67 38#include <linux/time.h>
e034d242 39#include <linux/uaccess.h>
be5bbd67
SR
40#include <linux/vmalloc.h>
41#include <linux/wait.h>
b1bda4cd 42#include <linux/workqueue.h>
be5bbd67 43
a64408b9 44#include <asm/system.h>
be5bbd67 45
77c9a5da 46#include "core.h"
19a15b93 47
19a15b93 48struct client {
344bbc4d 49 u32 version;
19a15b93 50 struct fw_device *device;
45ee3199 51
19a15b93 52 spinlock_t lock;
45ee3199
JF
53 bool in_shutdown;
54 struct idr resource_idr;
19a15b93 55 struct list_head event_list;
19a15b93 56 wait_queue_head_t wait;
da8ecffa 57 u64 bus_reset_closure;
9aad8125 58
19a15b93 59 struct fw_iso_context *iso_context;
abaa5743 60 u64 iso_closure;
9aad8125
KH
61 struct fw_iso_buffer buffer;
62 unsigned long vm_start;
97bd9efa
KH
63
64 struct list_head link;
fb443036 65 struct kref kref;
19a15b93
KH
66};
67
fb443036
SR
68static inline void client_get(struct client *client)
69{
70 kref_get(&client->kref);
71}
72
73static void client_release(struct kref *kref)
74{
75 struct client *client = container_of(kref, struct client, kref);
76
77 fw_device_put(client->device);
78 kfree(client);
79}
80
81static void client_put(struct client *client)
82{
83 kref_put(&client->kref, client_release);
84}
85
97c18b7f
SR
86struct client_resource;
87typedef void (*client_resource_release_fn_t)(struct client *,
88 struct client_resource *);
89struct client_resource {
90 client_resource_release_fn_t release;
91 int handle;
92};
93
94struct address_handler_resource {
95 struct client_resource resource;
96 struct fw_address_handler handler;
97 __u64 closure;
98 struct client *client;
99};
100
101struct outbound_transaction_resource {
102 struct client_resource resource;
103 struct fw_transaction transaction;
104};
105
106struct inbound_transaction_resource {
107 struct client_resource resource;
108 struct fw_request *request;
109 void *data;
110 size_t length;
111};
112
113struct descriptor_resource {
114 struct client_resource resource;
115 struct fw_descriptor descriptor;
116 u32 data[0];
117};
118
b1bda4cd
JFSR
119struct iso_resource {
120 struct client_resource resource;
121 struct client *client;
122 /* Schedule work and access todo only with client->lock held. */
123 struct delayed_work work;
1ec3c026
SR
124 enum {ISO_RES_ALLOC, ISO_RES_REALLOC, ISO_RES_DEALLOC,
125 ISO_RES_ALLOC_ONCE, ISO_RES_DEALLOC_ONCE,} todo;
b1bda4cd
JFSR
126 int generation;
127 u64 channels;
128 s32 bandwidth;
6fdc0370 129 __be32 transaction_data[2];
b1bda4cd
JFSR
130 struct iso_resource_event *e_alloc, *e_dealloc;
131};
132
b1bda4cd
JFSR
133static void release_iso_resource(struct client *, struct client_resource *);
134
9fb551bf
SR
135static void schedule_iso_resource(struct iso_resource *r, unsigned long delay)
136{
137 client_get(r->client);
138 if (!schedule_delayed_work(&r->work, delay))
139 client_put(r->client);
140}
141
142static void schedule_if_iso_resource(struct client_resource *resource)
143{
144 if (resource->release == release_iso_resource)
145 schedule_iso_resource(container_of(resource,
146 struct iso_resource, resource), 0);
147}
148
97c18b7f
SR
149/*
150 * dequeue_event() just kfree()'s the event, so the event has to be
151 * the first field in a struct XYZ_event.
152 */
153struct event {
154 struct { void *data; size_t size; } v[2];
155 struct list_head link;
156};
157
158struct bus_reset_event {
159 struct event event;
160 struct fw_cdev_event_bus_reset reset;
161};
162
163struct outbound_transaction_event {
164 struct event event;
165 struct client *client;
166 struct outbound_transaction_resource r;
167 struct fw_cdev_event_response response;
168};
169
170struct inbound_transaction_event {
171 struct event event;
172 struct fw_cdev_event_request request;
173};
174
175struct iso_interrupt_event {
176 struct event event;
177 struct fw_cdev_event_iso_interrupt interrupt;
178};
179
b1bda4cd
JFSR
180struct iso_resource_event {
181 struct event event;
e21fcf79 182 struct fw_cdev_event_iso_resource iso_resource;
b1bda4cd
JFSR
183};
184
53dca511 185static inline void __user *u64_to_uptr(__u64 value)
19a15b93
KH
186{
187 return (void __user *)(unsigned long)value;
188}
189
53dca511 190static inline __u64 uptr_to_u64(void __user *ptr)
19a15b93
KH
191{
192 return (__u64)(unsigned long)ptr;
193}
194
195static int fw_device_op_open(struct inode *inode, struct file *file)
196{
197 struct fw_device *device;
198 struct client *client;
199
96b19062 200 device = fw_device_get_by_devt(inode->i_rdev);
a3aca3da
KH
201 if (device == NULL)
202 return -ENODEV;
19a15b93 203
551f4cb9
JF
204 if (fw_device_is_shutdown(device)) {
205 fw_device_put(device);
206 return -ENODEV;
207 }
208
2d826cc5 209 client = kzalloc(sizeof(*client), GFP_KERNEL);
96b19062
SR
210 if (client == NULL) {
211 fw_device_put(device);
19a15b93 212 return -ENOMEM;
96b19062 213 }
19a15b93 214
96b19062 215 client->device = device;
19a15b93 216 spin_lock_init(&client->lock);
45ee3199
JF
217 idr_init(&client->resource_idr);
218 INIT_LIST_HEAD(&client->event_list);
19a15b93 219 init_waitqueue_head(&client->wait);
fb443036 220 kref_init(&client->kref);
19a15b93
KH
221
222 file->private_data = client;
223
d67cfb96 224 mutex_lock(&device->client_list_mutex);
97bd9efa 225 list_add_tail(&client->link, &device->client_list);
d67cfb96 226 mutex_unlock(&device->client_list_mutex);
97bd9efa 227
19a15b93
KH
228 return 0;
229}
230
231static void queue_event(struct client *client, struct event *event,
232 void *data0, size_t size0, void *data1, size_t size1)
233{
234 unsigned long flags;
235
236 event->v[0].data = data0;
237 event->v[0].size = size0;
238 event->v[1].data = data1;
239 event->v[1].size = size1;
240
241 spin_lock_irqsave(&client->lock, flags);
45ee3199
JF
242 if (client->in_shutdown)
243 kfree(event);
244 else
245 list_add_tail(&event->link, &client->event_list);
19a15b93 246 spin_unlock_irqrestore(&client->lock, flags);
83431cba
JF
247
248 wake_up_interruptible(&client->wait);
19a15b93
KH
249}
250
53dca511
SR
251static int dequeue_event(struct client *client,
252 char __user *buffer, size_t count)
19a15b93 253{
19a15b93
KH
254 struct event *event;
255 size_t size, total;
2dbd7d7e 256 int i, ret;
19a15b93 257
2dbd7d7e
SR
258 ret = wait_event_interruptible(client->wait,
259 !list_empty(&client->event_list) ||
260 fw_device_is_shutdown(client->device));
261 if (ret < 0)
262 return ret;
19a15b93 263
2603bf21
KH
264 if (list_empty(&client->event_list) &&
265 fw_device_is_shutdown(client->device))
266 return -ENODEV;
19a15b93 267
3ba94986 268 spin_lock_irq(&client->lock);
a459b8ab 269 event = list_first_entry(&client->event_list, struct event, link);
19a15b93 270 list_del(&event->link);
3ba94986 271 spin_unlock_irq(&client->lock);
19a15b93 272
19a15b93
KH
273 total = 0;
274 for (i = 0; i < ARRAY_SIZE(event->v) && total < count; i++) {
275 size = min(event->v[i].size, count - total);
2603bf21 276 if (copy_to_user(buffer + total, event->v[i].data, size)) {
2dbd7d7e 277 ret = -EFAULT;
19a15b93 278 goto out;
2603bf21 279 }
19a15b93
KH
280 total += size;
281 }
2dbd7d7e 282 ret = total;
19a15b93
KH
283
284 out:
285 kfree(event);
286
2dbd7d7e 287 return ret;
19a15b93
KH
288}
289
53dca511
SR
290static ssize_t fw_device_op_read(struct file *file, char __user *buffer,
291 size_t count, loff_t *offset)
19a15b93
KH
292{
293 struct client *client = file->private_data;
294
295 return dequeue_event(client, buffer, count);
296}
297
53dca511
SR
298static void fill_bus_reset_event(struct fw_cdev_event_bus_reset *event,
299 struct client *client)
344bbc4d 300{
da8ecffa 301 struct fw_card *card = client->device->card;
cf417e54 302
3ba94986 303 spin_lock_irq(&card->lock);
344bbc4d 304
da8ecffa 305 event->closure = client->bus_reset_closure;
344bbc4d 306 event->type = FW_CDEV_EVENT_BUS_RESET;
cf5a56ac 307 event->generation = client->device->generation;
da8ecffa 308 event->node_id = client->device->node_id;
344bbc4d
KH
309 event->local_node_id = card->local_node->node_id;
310 event->bm_node_id = 0; /* FIXME: We don't track the BM. */
311 event->irm_node_id = card->irm_node->node_id;
312 event->root_node_id = card->root_node->node_id;
cf417e54 313
3ba94986 314 spin_unlock_irq(&card->lock);
344bbc4d
KH
315}
316
53dca511
SR
317static void for_each_client(struct fw_device *device,
318 void (*callback)(struct client *client))
2603bf21 319{
2603bf21 320 struct client *c;
2603bf21 321
d67cfb96 322 mutex_lock(&device->client_list_mutex);
2603bf21
KH
323 list_for_each_entry(c, &device->client_list, link)
324 callback(c);
d67cfb96 325 mutex_unlock(&device->client_list_mutex);
2603bf21
KH
326}
327
b1bda4cd
JFSR
328static int schedule_reallocations(int id, void *p, void *data)
329{
9fb551bf 330 schedule_if_iso_resource(p);
b1bda4cd 331
b1bda4cd
JFSR
332 return 0;
333}
334
53dca511 335static void queue_bus_reset_event(struct client *client)
97bd9efa 336{
97c18b7f 337 struct bus_reset_event *e;
97bd9efa 338
97c18b7f
SR
339 e = kzalloc(sizeof(*e), GFP_KERNEL);
340 if (e == NULL) {
97bd9efa
KH
341 fw_notify("Out of memory when allocating bus reset event\n");
342 return;
343 }
344
97c18b7f 345 fill_bus_reset_event(&e->reset, client);
97bd9efa 346
97c18b7f
SR
347 queue_event(client, &e->event,
348 &e->reset, sizeof(e->reset), NULL, 0);
b1bda4cd
JFSR
349
350 spin_lock_irq(&client->lock);
351 idr_for_each(&client->resource_idr, schedule_reallocations, client);
352 spin_unlock_irq(&client->lock);
97bd9efa
KH
353}
354
355void fw_device_cdev_update(struct fw_device *device)
356{
2603bf21
KH
357 for_each_client(device, queue_bus_reset_event);
358}
97bd9efa 359
2603bf21
KH
360static void wake_up_client(struct client *client)
361{
362 wake_up_interruptible(&client->wait);
363}
97bd9efa 364
2603bf21
KH
365void fw_device_cdev_remove(struct fw_device *device)
366{
367 for_each_client(device, wake_up_client);
97bd9efa
KH
368}
369
4f259223 370static int ioctl_get_info(struct client *client, void *buffer)
19a15b93 371{
4f259223 372 struct fw_cdev_get_info *get_info = buffer;
344bbc4d 373 struct fw_cdev_event_bus_reset bus_reset;
c9755e14 374 unsigned long ret = 0;
344bbc4d 375
4f259223
KH
376 client->version = get_info->version;
377 get_info->version = FW_CDEV_VERSION;
cf417e54 378 get_info->card = client->device->card->index;
344bbc4d 379
c9755e14
SR
380 down_read(&fw_device_rwsem);
381
4f259223
KH
382 if (get_info->rom != 0) {
383 void __user *uptr = u64_to_uptr(get_info->rom);
384 size_t want = get_info->rom_length;
d84702a5 385 size_t have = client->device->config_rom_length * 4;
344bbc4d 386
c9755e14
SR
387 ret = copy_to_user(uptr, client->device->config_rom,
388 min(want, have));
344bbc4d 389 }
4f259223 390 get_info->rom_length = client->device->config_rom_length * 4;
344bbc4d 391
c9755e14
SR
392 up_read(&fw_device_rwsem);
393
394 if (ret != 0)
395 return -EFAULT;
396
4f259223
KH
397 client->bus_reset_closure = get_info->bus_reset_closure;
398 if (get_info->bus_reset != 0) {
399 void __user *uptr = u64_to_uptr(get_info->bus_reset);
344bbc4d 400
da8ecffa 401 fill_bus_reset_event(&bus_reset, client);
2d826cc5 402 if (copy_to_user(uptr, &bus_reset, sizeof(bus_reset)))
344bbc4d
KH
403 return -EFAULT;
404 }
19a15b93 405
19a15b93
KH
406 return 0;
407}
408
53dca511
SR
409static int add_client_resource(struct client *client,
410 struct client_resource *resource, gfp_t gfp_mask)
3964a449
KH
411{
412 unsigned long flags;
45ee3199
JF
413 int ret;
414
415 retry:
416 if (idr_pre_get(&client->resource_idr, gfp_mask) == 0)
417 return -ENOMEM;
3964a449
KH
418
419 spin_lock_irqsave(&client->lock, flags);
45ee3199
JF
420 if (client->in_shutdown)
421 ret = -ECANCELED;
422 else
423 ret = idr_get_new(&client->resource_idr, resource,
424 &resource->handle);
b1bda4cd 425 if (ret >= 0) {
fb443036 426 client_get(client);
9fb551bf 427 schedule_if_iso_resource(resource);
b1bda4cd 428 }
3964a449 429 spin_unlock_irqrestore(&client->lock, flags);
45ee3199
JF
430
431 if (ret == -EAGAIN)
432 goto retry;
433
434 return ret < 0 ? ret : 0;
3964a449
KH
435}
436
53dca511
SR
437static int release_client_resource(struct client *client, u32 handle,
438 client_resource_release_fn_t release,
e21fcf79 439 struct client_resource **return_resource)
3964a449 440{
e21fcf79 441 struct client_resource *resource;
3964a449 442
3ba94986 443 spin_lock_irq(&client->lock);
45ee3199 444 if (client->in_shutdown)
e21fcf79 445 resource = NULL;
45ee3199 446 else
e21fcf79
SR
447 resource = idr_find(&client->resource_idr, handle);
448 if (resource && resource->release == release)
45ee3199 449 idr_remove(&client->resource_idr, handle);
3ba94986 450 spin_unlock_irq(&client->lock);
3964a449 451
e21fcf79 452 if (!(resource && resource->release == release))
3964a449
KH
453 return -EINVAL;
454
e21fcf79
SR
455 if (return_resource)
456 *return_resource = resource;
3964a449 457 else
e21fcf79 458 resource->release(client, resource);
3964a449 459
fb443036
SR
460 client_put(client);
461
3964a449
KH
462 return 0;
463}
464
53dca511
SR
465static void release_transaction(struct client *client,
466 struct client_resource *resource)
3964a449 467{
97c18b7f
SR
468 struct outbound_transaction_resource *r = container_of(resource,
469 struct outbound_transaction_resource, resource);
3964a449 470
97c18b7f 471 fw_cancel_transaction(client->device->card, &r->transaction);
3964a449
KH
472}
473
53dca511
SR
474static void complete_transaction(struct fw_card *card, int rcode,
475 void *payload, size_t length, void *data)
19a15b93 476{
97c18b7f
SR
477 struct outbound_transaction_event *e = data;
478 struct fw_cdev_event_response *rsp = &e->response;
479 struct client *client = e->client;
28cf6a04 480 unsigned long flags;
19a15b93 481
97c18b7f
SR
482 if (length < rsp->length)
483 rsp->length = length;
19a15b93 484 if (rcode == RCODE_COMPLETE)
97c18b7f 485 memcpy(rsp->data, payload, rsp->length);
19a15b93 486
28cf6a04 487 spin_lock_irqsave(&client->lock, flags);
45ee3199 488 /*
fb443036
SR
489 * 1. If called while in shutdown, the idr tree must be left untouched.
490 * The idr handle will be removed and the client reference will be
491 * dropped later.
492 * 2. If the call chain was release_client_resource ->
493 * release_transaction -> complete_transaction (instead of a normal
494 * conclusion of the transaction), i.e. if this resource was already
495 * unregistered from the idr, the client reference will be dropped
496 * by release_client_resource and we must not drop it here.
45ee3199 497 */
fb443036 498 if (!client->in_shutdown &&
97c18b7f
SR
499 idr_find(&client->resource_idr, e->r.resource.handle)) {
500 idr_remove(&client->resource_idr, e->r.resource.handle);
fb443036
SR
501 /* Drop the idr's reference */
502 client_put(client);
503 }
28cf6a04
KH
504 spin_unlock_irqrestore(&client->lock, flags);
505
97c18b7f
SR
506 rsp->type = FW_CDEV_EVENT_RESPONSE;
507 rsp->rcode = rcode;
8401d92b
DM
508
509 /*
97c18b7f 510 * In the case that sizeof(*rsp) doesn't align with the position of the
8401d92b
DM
511 * data, and the read is short, preserve an extra copy of the data
512 * to stay compatible with a pre-2.6.27 bug. Since the bug is harmless
513 * for short reads and some apps depended on it, this is both safe
514 * and prudent for compatibility.
515 */
97c18b7f
SR
516 if (rsp->length <= sizeof(*rsp) - offsetof(typeof(*rsp), data))
517 queue_event(client, &e->event, rsp, sizeof(*rsp),
518 rsp->data, rsp->length);
8401d92b 519 else
97c18b7f 520 queue_event(client, &e->event, rsp, sizeof(*rsp) + rsp->length,
8401d92b 521 NULL, 0);
fb443036
SR
522
523 /* Drop the transaction callback's reference */
524 client_put(client);
19a15b93
KH
525}
526
acfe8333
JFSR
527static int init_request(struct client *client,
528 struct fw_cdev_send_request *request,
529 int destination_id, int speed)
19a15b93 530{
97c18b7f 531 struct outbound_transaction_event *e;
1f3125af 532 int ret;
19a15b93 533
18e9b10f
SR
534 if (request->tcode != TCODE_STREAM_DATA &&
535 (request->length > 4096 || request->length > 512 << speed))
5d3fd692 536 return -EIO;
19a15b93 537
97c18b7f
SR
538 e = kmalloc(sizeof(*e) + request->length, GFP_KERNEL);
539 if (e == NULL)
19a15b93
KH
540 return -ENOMEM;
541
97c18b7f
SR
542 e->client = client;
543 e->response.length = request->length;
544 e->response.closure = request->closure;
19a15b93 545
4f259223 546 if (request->data &&
97c18b7f 547 copy_from_user(e->response.data,
4f259223 548 u64_to_uptr(request->data), request->length)) {
1f3125af 549 ret = -EFAULT;
45ee3199 550 goto failed;
1f3125af
SR
551 }
552
97c18b7f
SR
553 e->r.resource.release = release_transaction;
554 ret = add_client_resource(client, &e->r.resource, GFP_KERNEL);
45ee3199
JF
555 if (ret < 0)
556 goto failed;
28cf6a04 557
fb443036
SR
558 /* Get a reference for the transaction callback */
559 client_get(client);
560
acfe8333 561 fw_send_request(client->device->card, &e->r.transaction,
664d8010
SR
562 request->tcode, destination_id, request->generation,
563 speed, request->offset, e->response.data,
564 request->length, complete_transaction, e);
565 return 0;
19a15b93 566
45ee3199 567 failed:
97c18b7f 568 kfree(e);
1f3125af
SR
569
570 return ret;
19a15b93
KH
571}
572
acfe8333
JFSR
573static int ioctl_send_request(struct client *client, void *buffer)
574{
575 struct fw_cdev_send_request *request = buffer;
576
577 switch (request->tcode) {
578 case TCODE_WRITE_QUADLET_REQUEST:
579 case TCODE_WRITE_BLOCK_REQUEST:
580 case TCODE_READ_QUADLET_REQUEST:
581 case TCODE_READ_BLOCK_REQUEST:
582 case TCODE_LOCK_MASK_SWAP:
583 case TCODE_LOCK_COMPARE_SWAP:
584 case TCODE_LOCK_FETCH_ADD:
585 case TCODE_LOCK_LITTLE_ADD:
586 case TCODE_LOCK_BOUNDED_ADD:
587 case TCODE_LOCK_WRAP_ADD:
588 case TCODE_LOCK_VENDOR_DEPENDENT:
589 break;
590 default:
591 return -EINVAL;
592 }
593
207fbefb 594 return init_request(client, request, client->device->node_id,
acfe8333
JFSR
595 client->device->max_speed);
596}
597
53dca511
SR
598static void release_request(struct client *client,
599 struct client_resource *resource)
3964a449 600{
97c18b7f
SR
601 struct inbound_transaction_resource *r = container_of(resource,
602 struct inbound_transaction_resource, resource);
3964a449 603
97c18b7f 604 fw_send_response(client->device->card, r->request,
3964a449 605 RCODE_CONFLICT_ERROR);
97c18b7f 606 kfree(r);
3964a449
KH
607}
608
97c18b7f 609static void handle_request(struct fw_card *card, struct fw_request *request,
53dca511
SR
610 int tcode, int destination, int source,
611 int generation, int speed,
612 unsigned long long offset,
613 void *payload, size_t length, void *callback_data)
19a15b93 614{
97c18b7f
SR
615 struct address_handler_resource *handler = callback_data;
616 struct inbound_transaction_resource *r;
617 struct inbound_transaction_event *e;
45ee3199 618 int ret;
19a15b93 619
97c18b7f 620 r = kmalloc(sizeof(*r), GFP_ATOMIC);
2d826cc5 621 e = kmalloc(sizeof(*e), GFP_ATOMIC);
97c18b7f 622 if (r == NULL || e == NULL)
45ee3199 623 goto failed;
19a15b93 624
97c18b7f
SR
625 r->request = request;
626 r->data = payload;
627 r->length = length;
19a15b93 628
97c18b7f
SR
629 r->resource.release = release_request;
630 ret = add_client_resource(handler->client, &r->resource, GFP_ATOMIC);
45ee3199
JF
631 if (ret < 0)
632 goto failed;
19a15b93
KH
633
634 e->request.type = FW_CDEV_EVENT_REQUEST;
635 e->request.tcode = tcode;
636 e->request.offset = offset;
637 e->request.length = length;
97c18b7f 638 e->request.handle = r->resource.handle;
19a15b93
KH
639 e->request.closure = handler->closure;
640
97c18b7f 641 queue_event(handler->client, &e->event,
2d826cc5 642 &e->request, sizeof(e->request), payload, length);
45ee3199
JF
643 return;
644
645 failed:
97c18b7f 646 kfree(r);
45ee3199 647 kfree(e);
97c18b7f 648 fw_send_response(card, request, RCODE_CONFLICT_ERROR);
19a15b93
KH
649}
650
53dca511
SR
651static void release_address_handler(struct client *client,
652 struct client_resource *resource)
3964a449 653{
97c18b7f
SR
654 struct address_handler_resource *r =
655 container_of(resource, struct address_handler_resource, resource);
3964a449 656
97c18b7f
SR
657 fw_core_remove_address_handler(&r->handler);
658 kfree(r);
3964a449
KH
659}
660
4f259223 661static int ioctl_allocate(struct client *client, void *buffer)
19a15b93 662{
4f259223 663 struct fw_cdev_allocate *request = buffer;
97c18b7f 664 struct address_handler_resource *r;
19a15b93 665 struct fw_address_region region;
45ee3199 666 int ret;
19a15b93 667
97c18b7f
SR
668 r = kmalloc(sizeof(*r), GFP_KERNEL);
669 if (r == NULL)
19a15b93
KH
670 return -ENOMEM;
671
4f259223
KH
672 region.start = request->offset;
673 region.end = request->offset + request->length;
97c18b7f
SR
674 r->handler.length = request->length;
675 r->handler.address_callback = handle_request;
676 r->handler.callback_data = r;
677 r->closure = request->closure;
678 r->client = client;
19a15b93 679
97c18b7f 680 ret = fw_core_add_address_handler(&r->handler, &region);
3e0b5f0d 681 if (ret < 0) {
97c18b7f 682 kfree(r);
3e0b5f0d 683 return ret;
19a15b93
KH
684 }
685
97c18b7f
SR
686 r->resource.release = release_address_handler;
687 ret = add_client_resource(client, &r->resource, GFP_KERNEL);
45ee3199 688 if (ret < 0) {
97c18b7f 689 release_address_handler(client, &r->resource);
45ee3199
JF
690 return ret;
691 }
97c18b7f 692 request->handle = r->resource.handle;
19a15b93
KH
693
694 return 0;
695}
696
4f259223 697static int ioctl_deallocate(struct client *client, void *buffer)
9472316b 698{
4f259223 699 struct fw_cdev_deallocate *request = buffer;
9472316b 700
45ee3199
JF
701 return release_client_resource(client, request->handle,
702 release_address_handler, NULL);
9472316b
KH
703}
704
4f259223 705static int ioctl_send_response(struct client *client, void *buffer)
19a15b93 706{
4f259223 707 struct fw_cdev_send_response *request = buffer;
3964a449 708 struct client_resource *resource;
97c18b7f 709 struct inbound_transaction_resource *r;
7e44c0b5 710 int ret = 0;
19a15b93 711
45ee3199
JF
712 if (release_client_resource(client, request->handle,
713 release_request, &resource) < 0)
19a15b93 714 return -EINVAL;
45ee3199 715
97c18b7f
SR
716 r = container_of(resource, struct inbound_transaction_resource,
717 resource);
4f259223
KH
718 if (request->length < r->length)
719 r->length = request->length;
7e44c0b5
SR
720
721 if (copy_from_user(r->data, u64_to_uptr(request->data), r->length)) {
722 ret = -EFAULT;
723 goto out;
724 }
19a15b93 725
4f259223 726 fw_send_response(client->device->card, r->request, request->rcode);
7e44c0b5 727 out:
19a15b93
KH
728 kfree(r);
729
7e44c0b5 730 return ret;
19a15b93
KH
731}
732
4f259223 733static int ioctl_initiate_bus_reset(struct client *client, void *buffer)
5371842b 734{
4f259223 735 struct fw_cdev_initiate_bus_reset *request = buffer;
5371842b
KH
736 int short_reset;
737
4f259223 738 short_reset = (request->type == FW_CDEV_SHORT_RESET);
5371842b
KH
739
740 return fw_core_initiate_bus_reset(client->device->card, short_reset);
741}
742
3964a449
KH
743static void release_descriptor(struct client *client,
744 struct client_resource *resource)
745{
97c18b7f
SR
746 struct descriptor_resource *r =
747 container_of(resource, struct descriptor_resource, resource);
3964a449 748
97c18b7f
SR
749 fw_core_remove_descriptor(&r->descriptor);
750 kfree(r);
3964a449
KH
751}
752
4f259223 753static int ioctl_add_descriptor(struct client *client, void *buffer)
66dea3e5 754{
4f259223 755 struct fw_cdev_add_descriptor *request = buffer;
97c18b7f 756 struct descriptor_resource *r;
45ee3199 757 int ret;
66dea3e5 758
de487da8 759 /* Access policy: Allow this ioctl only on local nodes' device files. */
92368890 760 if (!client->device->is_local)
de487da8
SR
761 return -ENOSYS;
762
4f259223 763 if (request->length > 256)
66dea3e5
KH
764 return -EINVAL;
765
97c18b7f
SR
766 r = kmalloc(sizeof(*r) + request->length * 4, GFP_KERNEL);
767 if (r == NULL)
66dea3e5
KH
768 return -ENOMEM;
769
97c18b7f 770 if (copy_from_user(r->data,
4f259223 771 u64_to_uptr(request->data), request->length * 4)) {
45ee3199
JF
772 ret = -EFAULT;
773 goto failed;
66dea3e5
KH
774 }
775
97c18b7f
SR
776 r->descriptor.length = request->length;
777 r->descriptor.immediate = request->immediate;
778 r->descriptor.key = request->key;
779 r->descriptor.data = r->data;
66dea3e5 780
97c18b7f 781 ret = fw_core_add_descriptor(&r->descriptor);
45ee3199
JF
782 if (ret < 0)
783 goto failed;
66dea3e5 784
97c18b7f
SR
785 r->resource.release = release_descriptor;
786 ret = add_client_resource(client, &r->resource, GFP_KERNEL);
45ee3199 787 if (ret < 0) {
97c18b7f 788 fw_core_remove_descriptor(&r->descriptor);
45ee3199
JF
789 goto failed;
790 }
97c18b7f 791 request->handle = r->resource.handle;
66dea3e5
KH
792
793 return 0;
45ee3199 794 failed:
97c18b7f 795 kfree(r);
45ee3199
JF
796
797 return ret;
66dea3e5
KH
798}
799
4f259223 800static int ioctl_remove_descriptor(struct client *client, void *buffer)
66dea3e5 801{
4f259223 802 struct fw_cdev_remove_descriptor *request = buffer;
66dea3e5 803
45ee3199
JF
804 return release_client_resource(client, request->handle,
805 release_descriptor, NULL);
66dea3e5
KH
806}
807
53dca511
SR
808static void iso_callback(struct fw_iso_context *context, u32 cycle,
809 size_t header_length, void *header, void *data)
19a15b93
KH
810{
811 struct client *client = data;
97c18b7f 812 struct iso_interrupt_event *e;
19a15b93 813
97c18b7f
SR
814 e = kzalloc(sizeof(*e) + header_length, GFP_ATOMIC);
815 if (e == NULL)
19a15b93
KH
816 return;
817
97c18b7f
SR
818 e->interrupt.type = FW_CDEV_EVENT_ISO_INTERRUPT;
819 e->interrupt.closure = client->iso_closure;
820 e->interrupt.cycle = cycle;
821 e->interrupt.header_length = header_length;
822 memcpy(e->interrupt.header, header, header_length);
823 queue_event(client, &e->event, &e->interrupt,
824 sizeof(e->interrupt) + header_length, NULL, 0);
19a15b93
KH
825}
826
4f259223 827static int ioctl_create_iso_context(struct client *client, void *buffer)
19a15b93 828{
4f259223 829 struct fw_cdev_create_iso_context *request = buffer;
24315c5e 830 struct fw_iso_context *context;
19a15b93 831
fae60312
SR
832 /* We only support one context at this time. */
833 if (client->iso_context != NULL)
834 return -EBUSY;
835
4f259223 836 if (request->channel > 63)
21efb3cf
KH
837 return -EINVAL;
838
4f259223 839 switch (request->type) {
c70dc788 840 case FW_ISO_CONTEXT_RECEIVE:
4f259223 841 if (request->header_size < 4 || (request->header_size & 3))
c70dc788 842 return -EINVAL;
98b6cbe8 843
c70dc788
KH
844 break;
845
846 case FW_ISO_CONTEXT_TRANSMIT:
4f259223 847 if (request->speed > SCODE_3200)
c70dc788
KH
848 return -EINVAL;
849
850 break;
851
852 default:
21efb3cf 853 return -EINVAL;
c70dc788
KH
854 }
855
24315c5e
KH
856 context = fw_iso_context_create(client->device->card,
857 request->type,
858 request->channel,
859 request->speed,
860 request->header_size,
861 iso_callback, client);
862 if (IS_ERR(context))
863 return PTR_ERR(context);
864
abaa5743 865 client->iso_closure = request->closure;
24315c5e 866 client->iso_context = context;
19a15b93 867
abaa5743
KH
868 /* We only support one context at this time. */
869 request->handle = 0;
870
19a15b93
KH
871 return 0;
872}
873
1ca31ae7
KH
874/* Macros for decoding the iso packet control header. */
875#define GET_PAYLOAD_LENGTH(v) ((v) & 0xffff)
876#define GET_INTERRUPT(v) (((v) >> 16) & 0x01)
877#define GET_SKIP(v) (((v) >> 17) & 0x01)
7a100344
SR
878#define GET_TAG(v) (((v) >> 18) & 0x03)
879#define GET_SY(v) (((v) >> 20) & 0x0f)
1ca31ae7
KH
880#define GET_HEADER_LENGTH(v) (((v) >> 24) & 0xff)
881
4f259223 882static int ioctl_queue_iso(struct client *client, void *buffer)
19a15b93 883{
4f259223 884 struct fw_cdev_queue_iso *request = buffer;
19a15b93 885 struct fw_cdev_iso_packet __user *p, *end, *next;
9b32d5f3 886 struct fw_iso_context *ctx = client->iso_context;
ef370ee7 887 unsigned long payload, buffer_end, header_length;
1ca31ae7 888 u32 control;
19a15b93
KH
889 int count;
890 struct {
891 struct fw_iso_packet packet;
892 u8 header[256];
893 } u;
894
abaa5743 895 if (ctx == NULL || request->handle != 0)
19a15b93 896 return -EINVAL;
19a15b93 897
c781c06d
KH
898 /*
899 * If the user passes a non-NULL data pointer, has mmap()'ed
19a15b93
KH
900 * the iso buffer, and the pointer points inside the buffer,
901 * we setup the payload pointers accordingly. Otherwise we
9aad8125 902 * set them both to 0, which will still let packets with
19a15b93
KH
903 * payload_length == 0 through. In other words, if no packets
904 * use the indirect payload, the iso buffer need not be mapped
c781c06d
KH
905 * and the request->data pointer is ignored.
906 */
19a15b93 907
4f259223 908 payload = (unsigned long)request->data - client->vm_start;
ef370ee7 909 buffer_end = client->buffer.page_count << PAGE_SHIFT;
4f259223 910 if (request->data == 0 || client->buffer.pages == NULL ||
ef370ee7 911 payload >= buffer_end) {
9aad8125 912 payload = 0;
ef370ee7 913 buffer_end = 0;
19a15b93
KH
914 }
915
1ccc9147
AV
916 p = (struct fw_cdev_iso_packet __user *)u64_to_uptr(request->packets);
917
918 if (!access_ok(VERIFY_READ, p, request->size))
19a15b93
KH
919 return -EFAULT;
920
4f259223 921 end = (void __user *)p + request->size;
19a15b93
KH
922 count = 0;
923 while (p < end) {
1ca31ae7 924 if (get_user(control, &p->control))
19a15b93 925 return -EFAULT;
1ca31ae7
KH
926 u.packet.payload_length = GET_PAYLOAD_LENGTH(control);
927 u.packet.interrupt = GET_INTERRUPT(control);
928 u.packet.skip = GET_SKIP(control);
929 u.packet.tag = GET_TAG(control);
930 u.packet.sy = GET_SY(control);
931 u.packet.header_length = GET_HEADER_LENGTH(control);
295e3feb 932
9b32d5f3 933 if (ctx->type == FW_ISO_CONTEXT_TRANSMIT) {
295e3feb
KH
934 header_length = u.packet.header_length;
935 } else {
c781c06d
KH
936 /*
937 * We require that header_length is a multiple of
938 * the fixed header size, ctx->header_size.
939 */
9b32d5f3
KH
940 if (ctx->header_size == 0) {
941 if (u.packet.header_length > 0)
942 return -EINVAL;
943 } else if (u.packet.header_length % ctx->header_size != 0) {
295e3feb 944 return -EINVAL;
9b32d5f3 945 }
295e3feb
KH
946 header_length = 0;
947 }
948
19a15b93 949 next = (struct fw_cdev_iso_packet __user *)
295e3feb 950 &p->header[header_length / 4];
19a15b93
KH
951 if (next > end)
952 return -EINVAL;
953 if (__copy_from_user
295e3feb 954 (u.packet.header, p->header, header_length))
19a15b93 955 return -EFAULT;
98b6cbe8 956 if (u.packet.skip && ctx->type == FW_ISO_CONTEXT_TRANSMIT &&
19a15b93
KH
957 u.packet.header_length + u.packet.payload_length > 0)
958 return -EINVAL;
ef370ee7 959 if (payload + u.packet.payload_length > buffer_end)
19a15b93
KH
960 return -EINVAL;
961
9b32d5f3
KH
962 if (fw_iso_context_queue(ctx, &u.packet,
963 &client->buffer, payload))
19a15b93
KH
964 break;
965
966 p = next;
967 payload += u.packet.payload_length;
968 count++;
969 }
970
4f259223
KH
971 request->size -= uptr_to_u64(p) - request->packets;
972 request->packets = uptr_to_u64(p);
973 request->data = client->vm_start + payload;
19a15b93
KH
974
975 return count;
976}
977
4f259223 978static int ioctl_start_iso(struct client *client, void *buffer)
19a15b93 979{
4f259223 980 struct fw_cdev_start_iso *request = buffer;
19a15b93 981
fae60312 982 if (client->iso_context == NULL || request->handle != 0)
abaa5743 983 return -EINVAL;
fae60312 984
eb0306ea 985 if (client->iso_context->type == FW_ISO_CONTEXT_RECEIVE) {
4f259223 986 if (request->tags == 0 || request->tags > 15)
eb0306ea
KH
987 return -EINVAL;
988
4f259223 989 if (request->sync > 15)
eb0306ea
KH
990 return -EINVAL;
991 }
992
4f259223
KH
993 return fw_iso_context_start(client->iso_context, request->cycle,
994 request->sync, request->tags);
19a15b93
KH
995}
996
4f259223 997static int ioctl_stop_iso(struct client *client, void *buffer)
b8295668 998{
abaa5743
KH
999 struct fw_cdev_stop_iso *request = buffer;
1000
fae60312 1001 if (client->iso_context == NULL || request->handle != 0)
abaa5743
KH
1002 return -EINVAL;
1003
b8295668
KH
1004 return fw_iso_context_stop(client->iso_context);
1005}
1006
a64408b9
SR
1007static int ioctl_get_cycle_timer(struct client *client, void *buffer)
1008{
1009 struct fw_cdev_get_cycle_timer *request = buffer;
1010 struct fw_card *card = client->device->card;
1011 unsigned long long bus_time;
1012 struct timeval tv;
1013 unsigned long flags;
1014
1015 preempt_disable();
1016 local_irq_save(flags);
1017
1018 bus_time = card->driver->get_bus_time(card);
1019 do_gettimeofday(&tv);
1020
1021 local_irq_restore(flags);
1022 preempt_enable();
1023
1024 request->local_time = tv.tv_sec * 1000000ULL + tv.tv_usec;
1025 request->cycle_timer = bus_time & 0xffffffff;
1026 return 0;
1027}
1028
b1bda4cd
JFSR
1029static void iso_resource_work(struct work_struct *work)
1030{
1031 struct iso_resource_event *e;
1032 struct iso_resource *r =
1033 container_of(work, struct iso_resource, work.work);
1034 struct client *client = r->client;
1035 int generation, channel, bandwidth, todo;
1036 bool skip, free, success;
1037
1038 spin_lock_irq(&client->lock);
1039 generation = client->device->generation;
1040 todo = r->todo;
1041 /* Allow 1000ms grace period for other reallocations. */
1042 if (todo == ISO_RES_ALLOC &&
1043 time_is_after_jiffies(client->device->card->reset_jiffies + HZ)) {
9fb551bf 1044 schedule_iso_resource(r, DIV_ROUND_UP(HZ, 3));
b1bda4cd
JFSR
1045 skip = true;
1046 } else {
1047 /* We could be called twice within the same generation. */
1048 skip = todo == ISO_RES_REALLOC &&
1049 r->generation == generation;
1050 }
1ec3c026
SR
1051 free = todo == ISO_RES_DEALLOC ||
1052 todo == ISO_RES_ALLOC_ONCE ||
1053 todo == ISO_RES_DEALLOC_ONCE;
b1bda4cd
JFSR
1054 r->generation = generation;
1055 spin_unlock_irq(&client->lock);
1056
1057 if (skip)
1058 goto out;
1059
1060 bandwidth = r->bandwidth;
1061
1062 fw_iso_resource_manage(client->device->card, generation,
1063 r->channels, &channel, &bandwidth,
1ec3c026
SR
1064 todo == ISO_RES_ALLOC ||
1065 todo == ISO_RES_REALLOC ||
6fdc0370
SR
1066 todo == ISO_RES_ALLOC_ONCE,
1067 r->transaction_data);
b1bda4cd
JFSR
1068 /*
1069 * Is this generation outdated already? As long as this resource sticks
1070 * in the idr, it will be scheduled again for a newer generation or at
1071 * shutdown.
1072 */
1073 if (channel == -EAGAIN &&
1074 (todo == ISO_RES_ALLOC || todo == ISO_RES_REALLOC))
1075 goto out;
1076
1077 success = channel >= 0 || bandwidth > 0;
1078
1079 spin_lock_irq(&client->lock);
1080 /*
1081 * Transit from allocation to reallocation, except if the client
1082 * requested deallocation in the meantime.
1083 */
1084 if (r->todo == ISO_RES_ALLOC)
1085 r->todo = ISO_RES_REALLOC;
1086 /*
1087 * Allocation or reallocation failure? Pull this resource out of the
1088 * idr and prepare for deletion, unless the client is shutting down.
1089 */
1090 if (r->todo == ISO_RES_REALLOC && !success &&
1091 !client->in_shutdown &&
1092 idr_find(&client->resource_idr, r->resource.handle)) {
1093 idr_remove(&client->resource_idr, r->resource.handle);
1094 client_put(client);
1095 free = true;
1096 }
1097 spin_unlock_irq(&client->lock);
1098
1099 if (todo == ISO_RES_ALLOC && channel >= 0)
5d9cb7d2 1100 r->channels = 1ULL << channel;
b1bda4cd
JFSR
1101
1102 if (todo == ISO_RES_REALLOC && success)
1103 goto out;
1104
1ec3c026 1105 if (todo == ISO_RES_ALLOC || todo == ISO_RES_ALLOC_ONCE) {
b1bda4cd
JFSR
1106 e = r->e_alloc;
1107 r->e_alloc = NULL;
1108 } else {
1109 e = r->e_dealloc;
1110 r->e_dealloc = NULL;
1111 }
e21fcf79
SR
1112 e->iso_resource.handle = r->resource.handle;
1113 e->iso_resource.channel = channel;
1114 e->iso_resource.bandwidth = bandwidth;
b1bda4cd
JFSR
1115
1116 queue_event(client, &e->event,
e21fcf79 1117 &e->iso_resource, sizeof(e->iso_resource), NULL, 0);
b1bda4cd
JFSR
1118
1119 if (free) {
1120 cancel_delayed_work(&r->work);
1121 kfree(r->e_alloc);
1122 kfree(r->e_dealloc);
1123 kfree(r);
1124 }
1125 out:
1126 client_put(client);
1127}
1128
b1bda4cd
JFSR
1129static void release_iso_resource(struct client *client,
1130 struct client_resource *resource)
1131{
1132 struct iso_resource *r =
1133 container_of(resource, struct iso_resource, resource);
1134
1135 spin_lock_irq(&client->lock);
1136 r->todo = ISO_RES_DEALLOC;
9fb551bf 1137 schedule_iso_resource(r, 0);
b1bda4cd
JFSR
1138 spin_unlock_irq(&client->lock);
1139}
1140
1ec3c026
SR
1141static int init_iso_resource(struct client *client,
1142 struct fw_cdev_allocate_iso_resource *request, int todo)
b1bda4cd 1143{
b1bda4cd
JFSR
1144 struct iso_resource_event *e1, *e2;
1145 struct iso_resource *r;
1146 int ret;
1147
1148 if ((request->channels == 0 && request->bandwidth == 0) ||
1149 request->bandwidth > BANDWIDTH_AVAILABLE_INITIAL ||
1150 request->bandwidth < 0)
1151 return -EINVAL;
1152
1153 r = kmalloc(sizeof(*r), GFP_KERNEL);
1154 e1 = kmalloc(sizeof(*e1), GFP_KERNEL);
1155 e2 = kmalloc(sizeof(*e2), GFP_KERNEL);
1156 if (r == NULL || e1 == NULL || e2 == NULL) {
1157 ret = -ENOMEM;
1158 goto fail;
1159 }
1160
1161 INIT_DELAYED_WORK(&r->work, iso_resource_work);
1162 r->client = client;
1ec3c026 1163 r->todo = todo;
b1bda4cd
JFSR
1164 r->generation = -1;
1165 r->channels = request->channels;
1166 r->bandwidth = request->bandwidth;
1167 r->e_alloc = e1;
1168 r->e_dealloc = e2;
1169
e21fcf79
SR
1170 e1->iso_resource.closure = request->closure;
1171 e1->iso_resource.type = FW_CDEV_EVENT_ISO_RESOURCE_ALLOCATED;
1172 e2->iso_resource.closure = request->closure;
1173 e2->iso_resource.type = FW_CDEV_EVENT_ISO_RESOURCE_DEALLOCATED;
b1bda4cd 1174
1ec3c026
SR
1175 if (todo == ISO_RES_ALLOC) {
1176 r->resource.release = release_iso_resource;
1177 ret = add_client_resource(client, &r->resource, GFP_KERNEL);
81610b8f
SR
1178 if (ret < 0)
1179 goto fail;
1ec3c026
SR
1180 } else {
1181 r->resource.release = NULL;
1182 r->resource.handle = -1;
9fb551bf 1183 schedule_iso_resource(r, 0);
1ec3c026 1184 }
b1bda4cd
JFSR
1185 request->handle = r->resource.handle;
1186
1187 return 0;
1188 fail:
1189 kfree(r);
1190 kfree(e1);
1191 kfree(e2);
1192
1193 return ret;
1194}
1195
1ec3c026
SR
1196static int ioctl_allocate_iso_resource(struct client *client, void *buffer)
1197{
1198 struct fw_cdev_allocate_iso_resource *request = buffer;
1199
1200 return init_iso_resource(client, request, ISO_RES_ALLOC);
1201}
1202
b1bda4cd
JFSR
1203static int ioctl_deallocate_iso_resource(struct client *client, void *buffer)
1204{
1205 struct fw_cdev_deallocate *request = buffer;
1206
1207 return release_client_resource(client, request->handle,
1208 release_iso_resource, NULL);
1209}
1210
1ec3c026
SR
1211static int ioctl_allocate_iso_resource_once(struct client *client, void *buffer)
1212{
1213 struct fw_cdev_allocate_iso_resource *request = buffer;
1214
1215 return init_iso_resource(client, request, ISO_RES_ALLOC_ONCE);
1216}
1217
1218static int ioctl_deallocate_iso_resource_once(struct client *client, void *buffer)
1219{
1220 struct fw_cdev_allocate_iso_resource *request = buffer;
1221
1222 return init_iso_resource(client, request, ISO_RES_DEALLOC_ONCE);
1223}
1224
c8a25900
SR
1225/*
1226 * Returns a speed code: Maximum speed to or from this device,
1227 * limited by the device's link speed, the local node's link speed,
1228 * and all PHY port speeds between the two links.
1229 */
33580a3e
SR
1230static int ioctl_get_speed(struct client *client, void *buffer)
1231{
c8a25900 1232 return client->device->max_speed;
33580a3e
SR
1233}
1234
acfe8333
JFSR
1235static int ioctl_send_broadcast_request(struct client *client, void *buffer)
1236{
1237 struct fw_cdev_send_request *request = buffer;
1238
1239 switch (request->tcode) {
1240 case TCODE_WRITE_QUADLET_REQUEST:
1241 case TCODE_WRITE_BLOCK_REQUEST:
1242 break;
1243 default:
1244 return -EINVAL;
1245 }
1246
1566f3dc
SR
1247 /* Security policy: Only allow accesses to Units Space. */
1248 if (request->offset < CSR_REGISTER_BASE + CSR_CONFIG_ROM_END)
1249 return -EACCES;
1250
acfe8333
JFSR
1251 return init_request(client, request, LOCAL_BUS | 0x3f, SCODE_100);
1252}
1253
f8c2287c
JF
1254static int ioctl_send_stream_packet(struct client *client, void *buffer)
1255{
18e9b10f
SR
1256 struct fw_cdev_send_stream_packet *p = buffer;
1257 struct fw_cdev_send_request request;
1258 int dest;
f8c2287c 1259
18e9b10f
SR
1260 if (p->speed > client->device->card->link_speed ||
1261 p->length > 1024 << p->speed)
1262 return -EIO;
f8c2287c 1263
18e9b10f
SR
1264 if (p->tag > 3 || p->channel > 63 || p->sy > 15)
1265 return -EINVAL;
1266
1267 dest = fw_stream_packet_destination_id(p->tag, p->channel, p->sy);
1268 request.tcode = TCODE_STREAM_DATA;
1269 request.length = p->length;
1270 request.closure = p->closure;
1271 request.data = p->data;
1272 request.generation = p->generation;
1273
1274 return init_request(client, &request, dest, p->speed);
f8c2287c
JF
1275}
1276
4f259223
KH
1277static int (* const ioctl_handlers[])(struct client *client, void *buffer) = {
1278 ioctl_get_info,
1279 ioctl_send_request,
1280 ioctl_allocate,
1281 ioctl_deallocate,
1282 ioctl_send_response,
1283 ioctl_initiate_bus_reset,
1284 ioctl_add_descriptor,
1285 ioctl_remove_descriptor,
1286 ioctl_create_iso_context,
1287 ioctl_queue_iso,
1288 ioctl_start_iso,
1289 ioctl_stop_iso,
a64408b9 1290 ioctl_get_cycle_timer,
b1bda4cd
JFSR
1291 ioctl_allocate_iso_resource,
1292 ioctl_deallocate_iso_resource,
1ec3c026
SR
1293 ioctl_allocate_iso_resource_once,
1294 ioctl_deallocate_iso_resource_once,
33580a3e 1295 ioctl_get_speed,
acfe8333 1296 ioctl_send_broadcast_request,
f8c2287c 1297 ioctl_send_stream_packet,
4f259223
KH
1298};
1299
53dca511
SR
1300static int dispatch_ioctl(struct client *client,
1301 unsigned int cmd, void __user *arg)
19a15b93 1302{
b2c0a2ac
SR
1303 char buffer[sizeof(union {
1304 struct fw_cdev_get_info _00;
1305 struct fw_cdev_send_request _01;
1306 struct fw_cdev_allocate _02;
1307 struct fw_cdev_deallocate _03;
1308 struct fw_cdev_send_response _04;
1309 struct fw_cdev_initiate_bus_reset _05;
1310 struct fw_cdev_add_descriptor _06;
1311 struct fw_cdev_remove_descriptor _07;
1312 struct fw_cdev_create_iso_context _08;
1313 struct fw_cdev_queue_iso _09;
1314 struct fw_cdev_start_iso _0a;
1315 struct fw_cdev_stop_iso _0b;
1316 struct fw_cdev_get_cycle_timer _0c;
1317 struct fw_cdev_allocate_iso_resource _0d;
1318 struct fw_cdev_send_stream_packet _13;
1319 })];
2dbd7d7e 1320 int ret;
4f259223
KH
1321
1322 if (_IOC_TYPE(cmd) != '#' ||
1323 _IOC_NR(cmd) >= ARRAY_SIZE(ioctl_handlers))
19a15b93 1324 return -EINVAL;
4f259223
KH
1325
1326 if (_IOC_DIR(cmd) & _IOC_WRITE) {
2d826cc5 1327 if (_IOC_SIZE(cmd) > sizeof(buffer) ||
4f259223
KH
1328 copy_from_user(buffer, arg, _IOC_SIZE(cmd)))
1329 return -EFAULT;
1330 }
1331
2dbd7d7e
SR
1332 ret = ioctl_handlers[_IOC_NR(cmd)](client, buffer);
1333 if (ret < 0)
1334 return ret;
4f259223
KH
1335
1336 if (_IOC_DIR(cmd) & _IOC_READ) {
2d826cc5 1337 if (_IOC_SIZE(cmd) > sizeof(buffer) ||
4f259223
KH
1338 copy_to_user(arg, buffer, _IOC_SIZE(cmd)))
1339 return -EFAULT;
19a15b93 1340 }
4f259223 1341
2dbd7d7e 1342 return ret;
19a15b93
KH
1343}
1344
53dca511
SR
1345static long fw_device_op_ioctl(struct file *file,
1346 unsigned int cmd, unsigned long arg)
19a15b93
KH
1347{
1348 struct client *client = file->private_data;
1349
551f4cb9
JF
1350 if (fw_device_is_shutdown(client->device))
1351 return -ENODEV;
1352
19a15b93
KH
1353 return dispatch_ioctl(client, cmd, (void __user *) arg);
1354}
1355
1356#ifdef CONFIG_COMPAT
53dca511
SR
1357static long fw_device_op_compat_ioctl(struct file *file,
1358 unsigned int cmd, unsigned long arg)
19a15b93
KH
1359{
1360 struct client *client = file->private_data;
1361
551f4cb9
JF
1362 if (fw_device_is_shutdown(client->device))
1363 return -ENODEV;
1364
19a15b93
KH
1365 return dispatch_ioctl(client, cmd, compat_ptr(arg));
1366}
1367#endif
1368
1369static int fw_device_op_mmap(struct file *file, struct vm_area_struct *vma)
1370{
1371 struct client *client = file->private_data;
9aad8125
KH
1372 enum dma_data_direction direction;
1373 unsigned long size;
2dbd7d7e 1374 int page_count, ret;
9aad8125 1375
551f4cb9
JF
1376 if (fw_device_is_shutdown(client->device))
1377 return -ENODEV;
1378
9aad8125
KH
1379 /* FIXME: We could support multiple buffers, but we don't. */
1380 if (client->buffer.pages != NULL)
1381 return -EBUSY;
1382
1383 if (!(vma->vm_flags & VM_SHARED))
1384 return -EINVAL;
19a15b93 1385
9aad8125 1386 if (vma->vm_start & ~PAGE_MASK)
19a15b93
KH
1387 return -EINVAL;
1388
1389 client->vm_start = vma->vm_start;
9aad8125
KH
1390 size = vma->vm_end - vma->vm_start;
1391 page_count = size >> PAGE_SHIFT;
1392 if (size & ~PAGE_MASK)
1393 return -EINVAL;
1394
1395 if (vma->vm_flags & VM_WRITE)
1396 direction = DMA_TO_DEVICE;
1397 else
1398 direction = DMA_FROM_DEVICE;
1399
2dbd7d7e
SR
1400 ret = fw_iso_buffer_init(&client->buffer, client->device->card,
1401 page_count, direction);
1402 if (ret < 0)
1403 return ret;
19a15b93 1404
2dbd7d7e
SR
1405 ret = fw_iso_buffer_map(&client->buffer, vma);
1406 if (ret < 0)
9aad8125
KH
1407 fw_iso_buffer_destroy(&client->buffer, client->device->card);
1408
2dbd7d7e 1409 return ret;
19a15b93
KH
1410}
1411
45ee3199
JF
1412static int shutdown_resource(int id, void *p, void *data)
1413{
e21fcf79 1414 struct client_resource *resource = p;
45ee3199
JF
1415 struct client *client = data;
1416
e21fcf79 1417 resource->release(client, resource);
fb443036 1418 client_put(client);
45ee3199
JF
1419
1420 return 0;
1421}
1422
19a15b93
KH
1423static int fw_device_op_release(struct inode *inode, struct file *file)
1424{
1425 struct client *client = file->private_data;
e21fcf79 1426 struct event *event, *next_event;
19a15b93 1427
97811e34
SR
1428 mutex_lock(&client->device->client_list_mutex);
1429 list_del(&client->link);
1430 mutex_unlock(&client->device->client_list_mutex);
1431
19a15b93
KH
1432 if (client->iso_context)
1433 fw_iso_context_destroy(client->iso_context);
1434
36a755cf
SR
1435 if (client->buffer.pages)
1436 fw_iso_buffer_destroy(&client->buffer, client->device->card);
1437
45ee3199 1438 /* Freeze client->resource_idr and client->event_list */
3ba94986 1439 spin_lock_irq(&client->lock);
45ee3199 1440 client->in_shutdown = true;
3ba94986 1441 spin_unlock_irq(&client->lock);
66dea3e5 1442
45ee3199
JF
1443 idr_for_each(&client->resource_idr, shutdown_resource, client);
1444 idr_remove_all(&client->resource_idr);
1445 idr_destroy(&client->resource_idr);
28cf6a04 1446
e21fcf79
SR
1447 list_for_each_entry_safe(event, next_event, &client->event_list, link)
1448 kfree(event);
19a15b93 1449
fb443036 1450 client_put(client);
19a15b93
KH
1451
1452 return 0;
1453}
1454
1455static unsigned int fw_device_op_poll(struct file *file, poll_table * pt)
1456{
1457 struct client *client = file->private_data;
2603bf21 1458 unsigned int mask = 0;
19a15b93
KH
1459
1460 poll_wait(file, &client->wait, pt);
1461
2603bf21
KH
1462 if (fw_device_is_shutdown(client->device))
1463 mask |= POLLHUP | POLLERR;
19a15b93 1464 if (!list_empty(&client->event_list))
2603bf21
KH
1465 mask |= POLLIN | POLLRDNORM;
1466
1467 return mask;
19a15b93
KH
1468}
1469
21ebcd12 1470const struct file_operations fw_device_ops = {
19a15b93
KH
1471 .owner = THIS_MODULE,
1472 .open = fw_device_op_open,
1473 .read = fw_device_op_read,
1474 .unlocked_ioctl = fw_device_op_ioctl,
1475 .poll = fw_device_op_poll,
1476 .release = fw_device_op_release,
1477 .mmap = fw_device_op_mmap,
1478
1479#ifdef CONFIG_COMPAT
5af4e5ea 1480 .compat_ioctl = fw_device_op_compat_ioctl,
19a15b93
KH
1481#endif
1482};