blob: 07c32a4bada2e7dc8b1186928ce2d2286da1e878 [file] [log] [blame]
Kristian Høgsbergc781c062007-05-07 20:33:32 -04001/*
2 * Char device for device raw access
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05003 *
Kristian Høgsbergc781c062007-05-07 20:33:32 -04004 * Copyright (C) 2005-2007 Kristian Hoegsberg <krh@bitplanet.net>
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05005 *
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
21#include <linux/module.h>
22#include <linux/kernel.h>
23#include <linux/wait.h>
24#include <linux/errno.h>
25#include <linux/device.h>
26#include <linux/vmalloc.h>
Stefan Richterd67cfb92008-10-05 10:37:11 +020027#include <linux/mutex.h>
Kristian Høgsberg19a15b92006-12-19 19:58:31 -050028#include <linux/poll.h>
Stefan Richtera64408b2007-09-29 10:41:58 +020029#include <linux/preempt.h>
30#include <linux/time.h>
Jay Fenlasoncf417e542008-10-03 11:19:09 -040031#include <linux/spinlock.h>
Kristian Høgsberg19a15b92006-12-19 19:58:31 -050032#include <linux/delay.h>
33#include <linux/mm.h>
Kristian Høgsberga3aca3d2007-03-07 12:12:44 -050034#include <linux/idr.h>
Kristian Høgsberg19a15b92006-12-19 19:58:31 -050035#include <linux/compat.h>
Kristian Høgsberg9640d3d2007-04-30 15:03:15 -040036#include <linux/firewire-cdev.h>
Stefan Richtera64408b2007-09-29 10:41:58 +020037#include <asm/system.h>
Kristian Høgsberg19a15b92006-12-19 19:58:31 -050038#include <asm/uaccess.h>
39#include "fw-transaction.h"
40#include "fw-topology.h"
41#include "fw-device.h"
Kristian Høgsberg19a15b92006-12-19 19:58:31 -050042
Kristian Høgsberg3964a442007-03-27 01:43:41 -040043struct client;
Jay Fenlason45ee3192008-12-21 16:47:17 +010044struct client_resource;
45typedef void (*client_resource_release_fn_t)(struct client *,
46 struct client_resource *);
Kristian Høgsberg3964a442007-03-27 01:43:41 -040047struct client_resource {
Jay Fenlason45ee3192008-12-21 16:47:17 +010048 client_resource_release_fn_t release;
49 int handle;
Kristian Høgsberg3964a442007-03-27 01:43:41 -040050};
51
Kristian Høgsbergc781c062007-05-07 20:33:32 -040052/*
53 * dequeue_event() just kfree()'s the event, so the event has to be
54 * the first field in the struct.
55 */
56
Kristian Høgsberg19a15b92006-12-19 19:58:31 -050057struct event {
58 struct { void *data; size_t size; } v[2];
59 struct list_head link;
60};
61
Kristian Høgsberg97bd9ef2007-03-07 12:12:41 -050062struct bus_reset {
63 struct event event;
64 struct fw_cdev_event_bus_reset reset;
65};
66
Kristian Høgsberg19a15b92006-12-19 19:58:31 -050067struct response {
68 struct event event;
69 struct fw_transaction transaction;
70 struct client *client;
Kristian Høgsberg3964a442007-03-27 01:43:41 -040071 struct client_resource resource;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -050072 struct fw_cdev_event_response response;
73};
74
75struct iso_interrupt {
76 struct event event;
77 struct fw_cdev_event_iso_interrupt interrupt;
78};
79
80struct client {
Kristian Høgsberg344bbc42007-03-07 12:12:43 -050081 u32 version;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -050082 struct fw_device *device;
Jay Fenlason45ee3192008-12-21 16:47:17 +010083
Kristian Høgsberg19a15b92006-12-19 19:58:31 -050084 spinlock_t lock;
Jay Fenlason45ee3192008-12-21 16:47:17 +010085 bool in_shutdown;
86 struct idr resource_idr;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -050087 struct list_head event_list;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -050088 wait_queue_head_t wait;
Kristian Høgsbergda8ecff2007-03-27 01:43:39 -040089 u64 bus_reset_closure;
Kristian Høgsberg9aad8122007-02-16 17:34:38 -050090
Kristian Høgsberg19a15b92006-12-19 19:58:31 -050091 struct fw_iso_context *iso_context;
Kristian Høgsbergabaa5742007-04-30 15:03:14 -040092 u64 iso_closure;
Kristian Høgsberg9aad8122007-02-16 17:34:38 -050093 struct fw_iso_buffer buffer;
94 unsigned long vm_start;
Kristian Høgsberg97bd9ef2007-03-07 12:12:41 -050095
96 struct list_head link;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -050097};
98
99static inline void __user *
100u64_to_uptr(__u64 value)
101{
102 return (void __user *)(unsigned long)value;
103}
104
105static inline __u64
106uptr_to_u64(void __user *ptr)
107{
108 return (__u64)(unsigned long)ptr;
109}
110
111static int fw_device_op_open(struct inode *inode, struct file *file)
112{
113 struct fw_device *device;
114 struct client *client;
115
Stefan Richter96b19062008-02-02 15:01:09 +0100116 device = fw_device_get_by_devt(inode->i_rdev);
Kristian Høgsberga3aca3d2007-03-07 12:12:44 -0500117 if (device == NULL)
118 return -ENODEV;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500119
Jay Fenlason551f4cb2008-05-16 11:15:23 -0400120 if (fw_device_is_shutdown(device)) {
121 fw_device_put(device);
122 return -ENODEV;
123 }
124
Kristian Høgsberg2d826cc2007-05-09 19:23:14 -0400125 client = kzalloc(sizeof(*client), GFP_KERNEL);
Stefan Richter96b19062008-02-02 15:01:09 +0100126 if (client == NULL) {
127 fw_device_put(device);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500128 return -ENOMEM;
Stefan Richter96b19062008-02-02 15:01:09 +0100129 }
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500130
Stefan Richter96b19062008-02-02 15:01:09 +0100131 client->device = device;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500132 spin_lock_init(&client->lock);
Jay Fenlason45ee3192008-12-21 16:47:17 +0100133 idr_init(&client->resource_idr);
134 INIT_LIST_HEAD(&client->event_list);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500135 init_waitqueue_head(&client->wait);
136
137 file->private_data = client;
138
Stefan Richterd67cfb92008-10-05 10:37:11 +0200139 mutex_lock(&device->client_list_mutex);
Kristian Høgsberg97bd9ef2007-03-07 12:12:41 -0500140 list_add_tail(&client->link, &device->client_list);
Stefan Richterd67cfb92008-10-05 10:37:11 +0200141 mutex_unlock(&device->client_list_mutex);
Kristian Høgsberg97bd9ef2007-03-07 12:12:41 -0500142
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500143 return 0;
144}
145
146static void queue_event(struct client *client, struct event *event,
147 void *data0, size_t size0, void *data1, size_t size1)
148{
149 unsigned long flags;
150
151 event->v[0].data = data0;
152 event->v[0].size = size0;
153 event->v[1].data = data1;
154 event->v[1].size = size1;
155
156 spin_lock_irqsave(&client->lock, flags);
Jay Fenlason45ee3192008-12-21 16:47:17 +0100157 if (client->in_shutdown)
158 kfree(event);
159 else
160 list_add_tail(&event->link, &client->event_list);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500161 spin_unlock_irqrestore(&client->lock, flags);
Jay Fenlason83431cb2007-10-08 17:00:29 -0400162
163 wake_up_interruptible(&client->wait);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500164}
165
Kristian Høgsberg2603bf22007-03-07 12:12:48 -0500166static int
167dequeue_event(struct client *client, char __user *buffer, size_t count)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500168{
169 unsigned long flags;
170 struct event *event;
171 size_t size, total;
Stefan Richter2dbd7d72008-12-14 21:45:45 +0100172 int i, ret;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500173
Stefan Richter2dbd7d72008-12-14 21:45:45 +0100174 ret = wait_event_interruptible(client->wait,
175 !list_empty(&client->event_list) ||
176 fw_device_is_shutdown(client->device));
177 if (ret < 0)
178 return ret;
Kristian Høgsberg2603bf22007-03-07 12:12:48 -0500179
180 if (list_empty(&client->event_list) &&
181 fw_device_is_shutdown(client->device))
182 return -ENODEV;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500183
184 spin_lock_irqsave(&client->lock, flags);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500185 event = container_of(client->event_list.next, struct event, link);
186 list_del(&event->link);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500187 spin_unlock_irqrestore(&client->lock, flags);
188
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500189 total = 0;
190 for (i = 0; i < ARRAY_SIZE(event->v) && total < count; i++) {
191 size = min(event->v[i].size, count - total);
Kristian Høgsberg2603bf22007-03-07 12:12:48 -0500192 if (copy_to_user(buffer + total, event->v[i].data, size)) {
Stefan Richter2dbd7d72008-12-14 21:45:45 +0100193 ret = -EFAULT;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500194 goto out;
Kristian Høgsberg2603bf22007-03-07 12:12:48 -0500195 }
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500196 total += size;
197 }
Stefan Richter2dbd7d72008-12-14 21:45:45 +0100198 ret = total;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500199
200 out:
201 kfree(event);
202
Stefan Richter2dbd7d72008-12-14 21:45:45 +0100203 return ret;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500204}
205
206static ssize_t
207fw_device_op_read(struct file *file,
208 char __user *buffer, size_t count, loff_t *offset)
209{
210 struct client *client = file->private_data;
211
212 return dequeue_event(client, buffer, count);
213}
214
Kristian Høgsberg97bd9ef2007-03-07 12:12:41 -0500215static void
Kristian Høgsberg344bbc42007-03-07 12:12:43 -0500216fill_bus_reset_event(struct fw_cdev_event_bus_reset *event,
Kristian Høgsbergda8ecff2007-03-27 01:43:39 -0400217 struct client *client)
Kristian Høgsberg344bbc42007-03-07 12:12:43 -0500218{
Kristian Høgsbergda8ecff2007-03-27 01:43:39 -0400219 struct fw_card *card = client->device->card;
Jay Fenlasoncf417e542008-10-03 11:19:09 -0400220 unsigned long flags;
221
222 spin_lock_irqsave(&card->lock, flags);
Kristian Høgsberg344bbc42007-03-07 12:12:43 -0500223
Kristian Høgsbergda8ecff2007-03-27 01:43:39 -0400224 event->closure = client->bus_reset_closure;
Kristian Høgsberg344bbc42007-03-07 12:12:43 -0500225 event->type = FW_CDEV_EVENT_BUS_RESET;
Stefan Richtercf5a56a2008-01-24 01:53:51 +0100226 event->generation = client->device->generation;
Kristian Høgsbergda8ecff2007-03-27 01:43:39 -0400227 event->node_id = client->device->node_id;
Kristian Høgsberg344bbc42007-03-07 12:12:43 -0500228 event->local_node_id = card->local_node->node_id;
229 event->bm_node_id = 0; /* FIXME: We don't track the BM. */
230 event->irm_node_id = card->irm_node->node_id;
231 event->root_node_id = card->root_node->node_id;
Jay Fenlasoncf417e542008-10-03 11:19:09 -0400232
233 spin_unlock_irqrestore(&card->lock, flags);
Kristian Høgsberg344bbc42007-03-07 12:12:43 -0500234}
235
236static void
Kristian Høgsberg2603bf22007-03-07 12:12:48 -0500237for_each_client(struct fw_device *device,
238 void (*callback)(struct client *client))
239{
Kristian Høgsberg2603bf22007-03-07 12:12:48 -0500240 struct client *c;
Kristian Høgsberg2603bf22007-03-07 12:12:48 -0500241
Stefan Richterd67cfb92008-10-05 10:37:11 +0200242 mutex_lock(&device->client_list_mutex);
Kristian Høgsberg2603bf22007-03-07 12:12:48 -0500243 list_for_each_entry(c, &device->client_list, link)
244 callback(c);
Stefan Richterd67cfb92008-10-05 10:37:11 +0200245 mutex_unlock(&device->client_list_mutex);
Kristian Høgsberg2603bf22007-03-07 12:12:48 -0500246}
247
248static void
Kristian Høgsberg97bd9ef2007-03-07 12:12:41 -0500249queue_bus_reset_event(struct client *client)
250{
251 struct bus_reset *bus_reset;
Kristian Høgsberg97bd9ef2007-03-07 12:12:41 -0500252
Stefan Richterd67cfb92008-10-05 10:37:11 +0200253 bus_reset = kzalloc(sizeof(*bus_reset), GFP_KERNEL);
Kristian Høgsberg97bd9ef2007-03-07 12:12:41 -0500254 if (bus_reset == NULL) {
255 fw_notify("Out of memory when allocating bus reset event\n");
256 return;
257 }
258
Kristian Høgsbergda8ecff2007-03-27 01:43:39 -0400259 fill_bus_reset_event(&bus_reset->reset, client);
Kristian Høgsberg97bd9ef2007-03-07 12:12:41 -0500260
261 queue_event(client, &bus_reset->event,
Kristian Høgsberg2d826cc2007-05-09 19:23:14 -0400262 &bus_reset->reset, sizeof(bus_reset->reset), NULL, 0);
Kristian Høgsberg97bd9ef2007-03-07 12:12:41 -0500263}
264
265void fw_device_cdev_update(struct fw_device *device)
266{
Kristian Høgsberg2603bf22007-03-07 12:12:48 -0500267 for_each_client(device, queue_bus_reset_event);
268}
Kristian Høgsberg97bd9ef2007-03-07 12:12:41 -0500269
Kristian Høgsberg2603bf22007-03-07 12:12:48 -0500270static void wake_up_client(struct client *client)
271{
272 wake_up_interruptible(&client->wait);
273}
Kristian Høgsberg97bd9ef2007-03-07 12:12:41 -0500274
Kristian Høgsberg2603bf22007-03-07 12:12:48 -0500275void fw_device_cdev_remove(struct fw_device *device)
276{
277 for_each_client(device, wake_up_client);
Kristian Høgsberg97bd9ef2007-03-07 12:12:41 -0500278}
279
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400280static int ioctl_get_info(struct client *client, void *buffer)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500281{
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400282 struct fw_cdev_get_info *get_info = buffer;
Kristian Høgsberg344bbc42007-03-07 12:12:43 -0500283 struct fw_cdev_event_bus_reset bus_reset;
Stefan Richterc9755e12008-03-24 20:54:28 +0100284 unsigned long ret = 0;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500285
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400286 client->version = get_info->version;
287 get_info->version = FW_CDEV_VERSION;
Jay Fenlasoncf417e542008-10-03 11:19:09 -0400288 get_info->card = client->device->card->index;
Kristian Høgsberg344bbc42007-03-07 12:12:43 -0500289
Stefan Richterc9755e12008-03-24 20:54:28 +0100290 down_read(&fw_device_rwsem);
291
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400292 if (get_info->rom != 0) {
293 void __user *uptr = u64_to_uptr(get_info->rom);
294 size_t want = get_info->rom_length;
Stefan Richterd84702a2007-03-20 19:42:15 +0100295 size_t have = client->device->config_rom_length * 4;
Kristian Høgsberg344bbc42007-03-07 12:12:43 -0500296
Stefan Richterc9755e12008-03-24 20:54:28 +0100297 ret = copy_to_user(uptr, client->device->config_rom,
298 min(want, have));
Kristian Høgsberg344bbc42007-03-07 12:12:43 -0500299 }
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400300 get_info->rom_length = client->device->config_rom_length * 4;
Kristian Høgsberg344bbc42007-03-07 12:12:43 -0500301
Stefan Richterc9755e12008-03-24 20:54:28 +0100302 up_read(&fw_device_rwsem);
303
304 if (ret != 0)
305 return -EFAULT;
306
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400307 client->bus_reset_closure = get_info->bus_reset_closure;
308 if (get_info->bus_reset != 0) {
309 void __user *uptr = u64_to_uptr(get_info->bus_reset);
Kristian Høgsberg344bbc42007-03-07 12:12:43 -0500310
Kristian Høgsbergda8ecff2007-03-27 01:43:39 -0400311 fill_bus_reset_event(&bus_reset, client);
Kristian Høgsberg2d826cc2007-05-09 19:23:14 -0400312 if (copy_to_user(uptr, &bus_reset, sizeof(bus_reset)))
Kristian Høgsberg344bbc42007-03-07 12:12:43 -0500313 return -EFAULT;
314 }
315
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500316 return 0;
317}
318
Jay Fenlason45ee3192008-12-21 16:47:17 +0100319static int
320add_client_resource(struct client *client, struct client_resource *resource,
321 gfp_t gfp_mask)
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400322{
323 unsigned long flags;
Jay Fenlason45ee3192008-12-21 16:47:17 +0100324 int ret;
325
326 retry:
327 if (idr_pre_get(&client->resource_idr, gfp_mask) == 0)
328 return -ENOMEM;
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400329
330 spin_lock_irqsave(&client->lock, flags);
Jay Fenlason45ee3192008-12-21 16:47:17 +0100331 if (client->in_shutdown)
332 ret = -ECANCELED;
333 else
334 ret = idr_get_new(&client->resource_idr, resource,
335 &resource->handle);
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400336 spin_unlock_irqrestore(&client->lock, flags);
Jay Fenlason45ee3192008-12-21 16:47:17 +0100337
338 if (ret == -EAGAIN)
339 goto retry;
340
341 return ret < 0 ? ret : 0;
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400342}
343
344static int
345release_client_resource(struct client *client, u32 handle,
Jay Fenlason45ee3192008-12-21 16:47:17 +0100346 client_resource_release_fn_t release,
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400347 struct client_resource **resource)
348{
349 struct client_resource *r;
350 unsigned long flags;
351
352 spin_lock_irqsave(&client->lock, flags);
Jay Fenlason45ee3192008-12-21 16:47:17 +0100353 if (client->in_shutdown)
354 r = NULL;
355 else
356 r = idr_find(&client->resource_idr, handle);
357 if (r && r->release == release)
358 idr_remove(&client->resource_idr, handle);
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400359 spin_unlock_irqrestore(&client->lock, flags);
360
Jay Fenlason45ee3192008-12-21 16:47:17 +0100361 if (!(r && r->release == release))
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400362 return -EINVAL;
363
364 if (resource)
365 *resource = r;
366 else
367 r->release(client, r);
368
369 return 0;
370}
371
372static void
373release_transaction(struct client *client, struct client_resource *resource)
374{
375 struct response *response =
376 container_of(resource, struct response, resource);
377
378 fw_cancel_transaction(client->device->card, &response->transaction);
379}
380
381static void
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500382complete_transaction(struct fw_card *card, int rcode,
383 void *payload, size_t length, void *data)
384{
385 struct response *response = data;
386 struct client *client = response->client;
Kristian Høgsberg28cf6a02007-03-07 12:12:50 -0500387 unsigned long flags;
David Moore8401d922008-07-29 23:46:25 -0700388 struct fw_cdev_event_response *r = &response->response;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500389
David Moore8401d922008-07-29 23:46:25 -0700390 if (length < r->length)
391 r->length = length;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500392 if (rcode == RCODE_COMPLETE)
David Moore8401d922008-07-29 23:46:25 -0700393 memcpy(r->data, payload, r->length);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500394
Kristian Høgsberg28cf6a02007-03-07 12:12:50 -0500395 spin_lock_irqsave(&client->lock, flags);
Jay Fenlason45ee3192008-12-21 16:47:17 +0100396 /*
397 * If called while in shutdown, the idr tree must be left untouched.
398 * The idr handle will be removed later.
399 */
400 if (!client->in_shutdown)
401 idr_remove(&client->resource_idr, response->resource.handle);
Kristian Høgsberg28cf6a02007-03-07 12:12:50 -0500402 spin_unlock_irqrestore(&client->lock, flags);
403
David Moore8401d922008-07-29 23:46:25 -0700404 r->type = FW_CDEV_EVENT_RESPONSE;
405 r->rcode = rcode;
406
407 /*
408 * In the case that sizeof(*r) doesn't align with the position of the
409 * data, and the read is short, preserve an extra copy of the data
410 * to stay compatible with a pre-2.6.27 bug. Since the bug is harmless
411 * for short reads and some apps depended on it, this is both safe
412 * and prudent for compatibility.
413 */
414 if (r->length <= sizeof(*r) - offsetof(typeof(*r), data))
415 queue_event(client, &response->event, r, sizeof(*r),
416 r->data, r->length);
417 else
418 queue_event(client, &response->event, r, sizeof(*r) + r->length,
419 NULL, 0);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500420}
421
Jeff Garzik350958f2007-05-27 07:09:18 -0400422static int ioctl_send_request(struct client *client, void *buffer)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500423{
424 struct fw_device *device = client->device;
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400425 struct fw_cdev_send_request *request = buffer;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500426 struct response *response;
Stefan Richter1f3125a2008-12-05 22:44:42 +0100427 int ret;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500428
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500429 /* What is the biggest size we'll accept, really? */
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400430 if (request->length > 4096)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500431 return -EINVAL;
432
Kristian Høgsberg2d826cc2007-05-09 19:23:14 -0400433 response = kmalloc(sizeof(*response) + request->length, GFP_KERNEL);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500434 if (response == NULL)
435 return -ENOMEM;
436
437 response->client = client;
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400438 response->response.length = request->length;
439 response->response.closure = request->closure;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500440
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400441 if (request->data &&
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500442 copy_from_user(response->response.data,
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400443 u64_to_uptr(request->data), request->length)) {
Stefan Richter1f3125a2008-12-05 22:44:42 +0100444 ret = -EFAULT;
Jay Fenlason45ee3192008-12-21 16:47:17 +0100445 goto failed;
Stefan Richter1f3125a2008-12-05 22:44:42 +0100446 }
447
448 switch (request->tcode) {
449 case TCODE_WRITE_QUADLET_REQUEST:
450 case TCODE_WRITE_BLOCK_REQUEST:
451 case TCODE_READ_QUADLET_REQUEST:
452 case TCODE_READ_BLOCK_REQUEST:
453 case TCODE_LOCK_MASK_SWAP:
454 case TCODE_LOCK_COMPARE_SWAP:
455 case TCODE_LOCK_FETCH_ADD:
456 case TCODE_LOCK_LITTLE_ADD:
457 case TCODE_LOCK_BOUNDED_ADD:
458 case TCODE_LOCK_WRAP_ADD:
459 case TCODE_LOCK_VENDOR_DEPENDENT:
460 break;
461 default:
462 ret = -EINVAL;
Jay Fenlason45ee3192008-12-21 16:47:17 +0100463 goto failed;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500464 }
465
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400466 response->resource.release = release_transaction;
Jay Fenlason45ee3192008-12-21 16:47:17 +0100467 ret = add_client_resource(client, &response->resource, GFP_KERNEL);
468 if (ret < 0)
469 goto failed;
Kristian Høgsberg28cf6a02007-03-07 12:12:50 -0500470
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500471 fw_send_request(device->card, &response->transaction,
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400472 request->tcode & 0x1f,
Stefan Richter907293d2007-01-23 21:11:43 +0100473 device->node->node_id,
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400474 request->generation,
Stefan Richterf1397492007-06-10 21:31:36 +0200475 device->max_speed,
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400476 request->offset,
477 response->response.data, request->length,
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500478 complete_transaction, response);
479
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400480 if (request->data)
Kristian Høgsberg2d826cc2007-05-09 19:23:14 -0400481 return sizeof(request) + request->length;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500482 else
Kristian Høgsberg2d826cc2007-05-09 19:23:14 -0400483 return sizeof(request);
Jay Fenlason45ee3192008-12-21 16:47:17 +0100484 failed:
Stefan Richter1f3125a2008-12-05 22:44:42 +0100485 kfree(response);
486
487 return ret;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500488}
489
490struct address_handler {
491 struct fw_address_handler handler;
492 __u64 closure;
493 struct client *client;
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400494 struct client_resource resource;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500495};
496
497struct request {
498 struct fw_request *request;
499 void *data;
500 size_t length;
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400501 struct client_resource resource;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500502};
503
504struct request_event {
505 struct event event;
506 struct fw_cdev_event_request request;
507};
508
509static void
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400510release_request(struct client *client, struct client_resource *resource)
511{
512 struct request *request =
513 container_of(resource, struct request, resource);
514
515 fw_send_response(client->device->card, request->request,
516 RCODE_CONFLICT_ERROR);
517 kfree(request);
518}
519
520static void
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500521handle_request(struct fw_card *card, struct fw_request *r,
522 int tcode, int destination, int source,
523 int generation, int speed,
524 unsigned long long offset,
525 void *payload, size_t length, void *callback_data)
526{
527 struct address_handler *handler = callback_data;
528 struct request *request;
529 struct request_event *e;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500530 struct client *client = handler->client;
Jay Fenlason45ee3192008-12-21 16:47:17 +0100531 int ret;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500532
Kristian Høgsberg2d826cc2007-05-09 19:23:14 -0400533 request = kmalloc(sizeof(*request), GFP_ATOMIC);
534 e = kmalloc(sizeof(*e), GFP_ATOMIC);
Jay Fenlason45ee3192008-12-21 16:47:17 +0100535 if (request == NULL || e == NULL)
536 goto failed;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500537
538 request->request = r;
539 request->data = payload;
540 request->length = length;
541
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400542 request->resource.release = release_request;
Jay Fenlason45ee3192008-12-21 16:47:17 +0100543 ret = add_client_resource(client, &request->resource, GFP_ATOMIC);
544 if (ret < 0)
545 goto failed;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500546
547 e->request.type = FW_CDEV_EVENT_REQUEST;
548 e->request.tcode = tcode;
549 e->request.offset = offset;
550 e->request.length = length;
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400551 e->request.handle = request->resource.handle;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500552 e->request.closure = handler->closure;
553
554 queue_event(client, &e->event,
Kristian Høgsberg2d826cc2007-05-09 19:23:14 -0400555 &e->request, sizeof(e->request), payload, length);
Jay Fenlason45ee3192008-12-21 16:47:17 +0100556 return;
557
558 failed:
559 kfree(request);
560 kfree(e);
561 fw_send_response(card, r, RCODE_CONFLICT_ERROR);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500562}
563
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400564static void
565release_address_handler(struct client *client,
566 struct client_resource *resource)
567{
568 struct address_handler *handler =
569 container_of(resource, struct address_handler, resource);
570
571 fw_core_remove_address_handler(&handler->handler);
572 kfree(handler);
573}
574
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400575static int ioctl_allocate(struct client *client, void *buffer)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500576{
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400577 struct fw_cdev_allocate *request = buffer;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500578 struct address_handler *handler;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500579 struct fw_address_region region;
Jay Fenlason45ee3192008-12-21 16:47:17 +0100580 int ret;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500581
Kristian Høgsberg2d826cc2007-05-09 19:23:14 -0400582 handler = kmalloc(sizeof(*handler), GFP_KERNEL);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500583 if (handler == NULL)
584 return -ENOMEM;
585
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400586 region.start = request->offset;
587 region.end = request->offset + request->length;
588 handler->handler.length = request->length;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500589 handler->handler.address_callback = handle_request;
590 handler->handler.callback_data = handler;
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400591 handler->closure = request->closure;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500592 handler->client = client;
593
Stefan Richter3e0b5f02008-12-14 19:21:01 +0100594 ret = fw_core_add_address_handler(&handler->handler, &region);
595 if (ret < 0) {
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500596 kfree(handler);
Stefan Richter3e0b5f02008-12-14 19:21:01 +0100597 return ret;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500598 }
599
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400600 handler->resource.release = release_address_handler;
Jay Fenlason45ee3192008-12-21 16:47:17 +0100601 ret = add_client_resource(client, &handler->resource, GFP_KERNEL);
602 if (ret < 0) {
603 release_address_handler(client, &handler->resource);
604 return ret;
605 }
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400606 request->handle = handler->resource.handle;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500607
608 return 0;
609}
610
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400611static int ioctl_deallocate(struct client *client, void *buffer)
Kristian Høgsberg94723162007-03-14 17:34:55 -0400612{
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400613 struct fw_cdev_deallocate *request = buffer;
Kristian Høgsberg94723162007-03-14 17:34:55 -0400614
Jay Fenlason45ee3192008-12-21 16:47:17 +0100615 return release_client_resource(client, request->handle,
616 release_address_handler, NULL);
Kristian Høgsberg94723162007-03-14 17:34:55 -0400617}
618
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400619static int ioctl_send_response(struct client *client, void *buffer)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500620{
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400621 struct fw_cdev_send_response *request = buffer;
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400622 struct client_resource *resource;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500623 struct request *r;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500624
Jay Fenlason45ee3192008-12-21 16:47:17 +0100625 if (release_client_resource(client, request->handle,
626 release_request, &resource) < 0)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500627 return -EINVAL;
Jay Fenlason45ee3192008-12-21 16:47:17 +0100628
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400629 r = container_of(resource, struct request, resource);
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400630 if (request->length < r->length)
631 r->length = request->length;
632 if (copy_from_user(r->data, u64_to_uptr(request->data), r->length))
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500633 return -EFAULT;
634
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400635 fw_send_response(client->device->card, r->request, request->rcode);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500636 kfree(r);
637
638 return 0;
639}
640
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400641static int ioctl_initiate_bus_reset(struct client *client, void *buffer)
Kristian Høgsberg53718422007-03-07 12:12:42 -0500642{
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400643 struct fw_cdev_initiate_bus_reset *request = buffer;
Kristian Høgsberg53718422007-03-07 12:12:42 -0500644 int short_reset;
645
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400646 short_reset = (request->type == FW_CDEV_SHORT_RESET);
Kristian Høgsberg53718422007-03-07 12:12:42 -0500647
648 return fw_core_initiate_bus_reset(client->device->card, short_reset);
649}
650
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200651struct descriptor {
652 struct fw_descriptor d;
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400653 struct client_resource resource;
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200654 u32 data[0];
655};
656
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400657static void release_descriptor(struct client *client,
658 struct client_resource *resource)
659{
660 struct descriptor *descriptor =
661 container_of(resource, struct descriptor, resource);
662
663 fw_core_remove_descriptor(&descriptor->d);
664 kfree(descriptor);
665}
666
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400667static int ioctl_add_descriptor(struct client *client, void *buffer)
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200668{
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400669 struct fw_cdev_add_descriptor *request = buffer;
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200670 struct descriptor *descriptor;
Jay Fenlason45ee3192008-12-21 16:47:17 +0100671 int ret;
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200672
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400673 if (request->length > 256)
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200674 return -EINVAL;
675
676 descriptor =
Kristian Høgsberg2d826cc2007-05-09 19:23:14 -0400677 kmalloc(sizeof(*descriptor) + request->length * 4, GFP_KERNEL);
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200678 if (descriptor == NULL)
679 return -ENOMEM;
680
681 if (copy_from_user(descriptor->data,
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400682 u64_to_uptr(request->data), request->length * 4)) {
Jay Fenlason45ee3192008-12-21 16:47:17 +0100683 ret = -EFAULT;
684 goto failed;
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200685 }
686
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400687 descriptor->d.length = request->length;
688 descriptor->d.immediate = request->immediate;
689 descriptor->d.key = request->key;
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200690 descriptor->d.data = descriptor->data;
691
Jay Fenlason45ee3192008-12-21 16:47:17 +0100692 ret = fw_core_add_descriptor(&descriptor->d);
693 if (ret < 0)
694 goto failed;
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200695
Kristian Høgsberg3964a442007-03-27 01:43:41 -0400696 descriptor->resource.release = release_descriptor;
Jay Fenlason45ee3192008-12-21 16:47:17 +0100697 ret = add_client_resource(client, &descriptor->resource, GFP_KERNEL);
698 if (ret < 0) {
699 fw_core_remove_descriptor(&descriptor->d);
700 goto failed;
701 }
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400702 request->handle = descriptor->resource.handle;
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200703
704 return 0;
Jay Fenlason45ee3192008-12-21 16:47:17 +0100705 failed:
706 kfree(descriptor);
707
708 return ret;
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200709}
710
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400711static int ioctl_remove_descriptor(struct client *client, void *buffer)
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200712{
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400713 struct fw_cdev_remove_descriptor *request = buffer;
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200714
Jay Fenlason45ee3192008-12-21 16:47:17 +0100715 return release_client_resource(client, request->handle,
716 release_descriptor, NULL);
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200717}
718
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500719static void
Kristian Høgsberg9b32d5f2007-02-16 17:34:44 -0500720iso_callback(struct fw_iso_context *context, u32 cycle,
721 size_t header_length, void *header, void *data)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500722{
723 struct client *client = data;
Stefan Richter930e4b72007-08-03 20:56:31 +0200724 struct iso_interrupt *irq;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500725
Stefan Richter930e4b72007-08-03 20:56:31 +0200726 irq = kzalloc(sizeof(*irq) + header_length, GFP_ATOMIC);
727 if (irq == NULL)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500728 return;
729
Stefan Richter930e4b72007-08-03 20:56:31 +0200730 irq->interrupt.type = FW_CDEV_EVENT_ISO_INTERRUPT;
731 irq->interrupt.closure = client->iso_closure;
732 irq->interrupt.cycle = cycle;
733 irq->interrupt.header_length = header_length;
734 memcpy(irq->interrupt.header, header, header_length);
735 queue_event(client, &irq->event, &irq->interrupt,
736 sizeof(irq->interrupt) + header_length, NULL, 0);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500737}
738
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400739static int ioctl_create_iso_context(struct client *client, void *buffer)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500740{
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400741 struct fw_cdev_create_iso_context *request = buffer;
Kristian Høgsberg24315c52007-06-20 17:48:07 -0400742 struct fw_iso_context *context;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500743
Stefan Richterfae60312008-02-20 21:10:06 +0100744 /* We only support one context at this time. */
745 if (client->iso_context != NULL)
746 return -EBUSY;
747
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400748 if (request->channel > 63)
Kristian Høgsberg21efb3c2007-02-16 17:34:50 -0500749 return -EINVAL;
750
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400751 switch (request->type) {
Kristian Høgsbergc70dc782007-03-14 17:34:53 -0400752 case FW_ISO_CONTEXT_RECEIVE:
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400753 if (request->header_size < 4 || (request->header_size & 3))
Kristian Høgsbergc70dc782007-03-14 17:34:53 -0400754 return -EINVAL;
755
756 break;
757
758 case FW_ISO_CONTEXT_TRANSMIT:
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400759 if (request->speed > SCODE_3200)
Kristian Høgsbergc70dc782007-03-14 17:34:53 -0400760 return -EINVAL;
761
762 break;
763
764 default:
Kristian Høgsberg21efb3c2007-02-16 17:34:50 -0500765 return -EINVAL;
Kristian Høgsbergc70dc782007-03-14 17:34:53 -0400766 }
767
Kristian Høgsberg24315c52007-06-20 17:48:07 -0400768 context = fw_iso_context_create(client->device->card,
769 request->type,
770 request->channel,
771 request->speed,
772 request->header_size,
773 iso_callback, client);
774 if (IS_ERR(context))
775 return PTR_ERR(context);
776
Kristian Høgsbergabaa5742007-04-30 15:03:14 -0400777 client->iso_closure = request->closure;
Kristian Høgsberg24315c52007-06-20 17:48:07 -0400778 client->iso_context = context;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500779
Kristian Høgsbergabaa5742007-04-30 15:03:14 -0400780 /* We only support one context at this time. */
781 request->handle = 0;
782
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500783 return 0;
784}
785
Kristian Høgsberg1ca31ae2007-05-31 11:16:43 -0400786/* Macros for decoding the iso packet control header. */
787#define GET_PAYLOAD_LENGTH(v) ((v) & 0xffff)
788#define GET_INTERRUPT(v) (((v) >> 16) & 0x01)
789#define GET_SKIP(v) (((v) >> 17) & 0x01)
Stefan Richter7a100342008-09-12 18:09:55 +0200790#define GET_TAG(v) (((v) >> 18) & 0x03)
791#define GET_SY(v) (((v) >> 20) & 0x0f)
Kristian Høgsberg1ca31ae2007-05-31 11:16:43 -0400792#define GET_HEADER_LENGTH(v) (((v) >> 24) & 0xff)
793
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400794static int ioctl_queue_iso(struct client *client, void *buffer)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500795{
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400796 struct fw_cdev_queue_iso *request = buffer;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500797 struct fw_cdev_iso_packet __user *p, *end, *next;
Kristian Høgsberg9b32d5f2007-02-16 17:34:44 -0500798 struct fw_iso_context *ctx = client->iso_context;
Kristian Høgsbergef370ee2007-03-28 20:46:23 +0200799 unsigned long payload, buffer_end, header_length;
Kristian Høgsberg1ca31ae2007-05-31 11:16:43 -0400800 u32 control;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500801 int count;
802 struct {
803 struct fw_iso_packet packet;
804 u8 header[256];
805 } u;
806
Kristian Høgsbergabaa5742007-04-30 15:03:14 -0400807 if (ctx == NULL || request->handle != 0)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500808 return -EINVAL;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500809
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400810 /*
811 * If the user passes a non-NULL data pointer, has mmap()'ed
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500812 * the iso buffer, and the pointer points inside the buffer,
813 * we setup the payload pointers accordingly. Otherwise we
Kristian Høgsberg9aad8122007-02-16 17:34:38 -0500814 * set them both to 0, which will still let packets with
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500815 * payload_length == 0 through. In other words, if no packets
816 * use the indirect payload, the iso buffer need not be mapped
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400817 * and the request->data pointer is ignored.
818 */
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500819
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400820 payload = (unsigned long)request->data - client->vm_start;
Kristian Høgsbergef370ee2007-03-28 20:46:23 +0200821 buffer_end = client->buffer.page_count << PAGE_SHIFT;
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400822 if (request->data == 0 || client->buffer.pages == NULL ||
Kristian Høgsbergef370ee2007-03-28 20:46:23 +0200823 payload >= buffer_end) {
Kristian Høgsberg9aad8122007-02-16 17:34:38 -0500824 payload = 0;
Kristian Høgsbergef370ee2007-03-28 20:46:23 +0200825 buffer_end = 0;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500826 }
827
Al Viro1ccc9142007-10-14 19:34:40 +0100828 p = (struct fw_cdev_iso_packet __user *)u64_to_uptr(request->packets);
829
830 if (!access_ok(VERIFY_READ, p, request->size))
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500831 return -EFAULT;
832
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400833 end = (void __user *)p + request->size;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500834 count = 0;
835 while (p < end) {
Kristian Høgsberg1ca31ae2007-05-31 11:16:43 -0400836 if (get_user(control, &p->control))
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500837 return -EFAULT;
Kristian Høgsberg1ca31ae2007-05-31 11:16:43 -0400838 u.packet.payload_length = GET_PAYLOAD_LENGTH(control);
839 u.packet.interrupt = GET_INTERRUPT(control);
840 u.packet.skip = GET_SKIP(control);
841 u.packet.tag = GET_TAG(control);
842 u.packet.sy = GET_SY(control);
843 u.packet.header_length = GET_HEADER_LENGTH(control);
Kristian Høgsberg295e3fe2007-02-16 17:34:40 -0500844
Kristian Høgsberg9b32d5f2007-02-16 17:34:44 -0500845 if (ctx->type == FW_ISO_CONTEXT_TRANSMIT) {
Kristian Høgsberg295e3fe2007-02-16 17:34:40 -0500846 header_length = u.packet.header_length;
847 } else {
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400848 /*
849 * We require that header_length is a multiple of
850 * the fixed header size, ctx->header_size.
851 */
Kristian Høgsberg9b32d5f2007-02-16 17:34:44 -0500852 if (ctx->header_size == 0) {
853 if (u.packet.header_length > 0)
854 return -EINVAL;
855 } else if (u.packet.header_length % ctx->header_size != 0) {
Kristian Høgsberg295e3fe2007-02-16 17:34:40 -0500856 return -EINVAL;
Kristian Høgsberg9b32d5f2007-02-16 17:34:44 -0500857 }
Kristian Høgsberg295e3fe2007-02-16 17:34:40 -0500858 header_length = 0;
859 }
860
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500861 next = (struct fw_cdev_iso_packet __user *)
Kristian Høgsberg295e3fe2007-02-16 17:34:40 -0500862 &p->header[header_length / 4];
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500863 if (next > end)
864 return -EINVAL;
865 if (__copy_from_user
Kristian Høgsberg295e3fe2007-02-16 17:34:40 -0500866 (u.packet.header, p->header, header_length))
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500867 return -EFAULT;
Kristian Høgsberg98b6cbe2007-02-16 17:34:51 -0500868 if (u.packet.skip && ctx->type == FW_ISO_CONTEXT_TRANSMIT &&
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500869 u.packet.header_length + u.packet.payload_length > 0)
870 return -EINVAL;
Kristian Høgsbergef370ee2007-03-28 20:46:23 +0200871 if (payload + u.packet.payload_length > buffer_end)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500872 return -EINVAL;
873
Kristian Høgsberg9b32d5f2007-02-16 17:34:44 -0500874 if (fw_iso_context_queue(ctx, &u.packet,
875 &client->buffer, payload))
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500876 break;
877
878 p = next;
879 payload += u.packet.payload_length;
880 count++;
881 }
882
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400883 request->size -= uptr_to_u64(p) - request->packets;
884 request->packets = uptr_to_u64(p);
885 request->data = client->vm_start + payload;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500886
887 return count;
888}
889
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400890static int ioctl_start_iso(struct client *client, void *buffer)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500891{
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400892 struct fw_cdev_start_iso *request = buffer;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500893
Stefan Richterfae60312008-02-20 21:10:06 +0100894 if (client->iso_context == NULL || request->handle != 0)
Kristian Høgsbergabaa5742007-04-30 15:03:14 -0400895 return -EINVAL;
Stefan Richterfae60312008-02-20 21:10:06 +0100896
Kristian Høgsbergeb0306e2007-03-14 17:34:54 -0400897 if (client->iso_context->type == FW_ISO_CONTEXT_RECEIVE) {
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400898 if (request->tags == 0 || request->tags > 15)
Kristian Høgsbergeb0306e2007-03-14 17:34:54 -0400899 return -EINVAL;
900
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400901 if (request->sync > 15)
Kristian Høgsbergeb0306e2007-03-14 17:34:54 -0400902 return -EINVAL;
903 }
904
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400905 return fw_iso_context_start(client->iso_context, request->cycle,
906 request->sync, request->tags);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500907}
908
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400909static int ioctl_stop_iso(struct client *client, void *buffer)
Kristian Høgsbergb8295662007-02-16 17:34:42 -0500910{
Kristian Høgsbergabaa5742007-04-30 15:03:14 -0400911 struct fw_cdev_stop_iso *request = buffer;
912
Stefan Richterfae60312008-02-20 21:10:06 +0100913 if (client->iso_context == NULL || request->handle != 0)
Kristian Høgsbergabaa5742007-04-30 15:03:14 -0400914 return -EINVAL;
915
Kristian Høgsbergb8295662007-02-16 17:34:42 -0500916 return fw_iso_context_stop(client->iso_context);
917}
918
Stefan Richtera64408b2007-09-29 10:41:58 +0200919static int ioctl_get_cycle_timer(struct client *client, void *buffer)
920{
921 struct fw_cdev_get_cycle_timer *request = buffer;
922 struct fw_card *card = client->device->card;
923 unsigned long long bus_time;
924 struct timeval tv;
925 unsigned long flags;
926
927 preempt_disable();
928 local_irq_save(flags);
929
930 bus_time = card->driver->get_bus_time(card);
931 do_gettimeofday(&tv);
932
933 local_irq_restore(flags);
934 preempt_enable();
935
936 request->local_time = tv.tv_sec * 1000000ULL + tv.tv_usec;
937 request->cycle_timer = bus_time & 0xffffffff;
938 return 0;
939}
940
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400941static int (* const ioctl_handlers[])(struct client *client, void *buffer) = {
942 ioctl_get_info,
943 ioctl_send_request,
944 ioctl_allocate,
945 ioctl_deallocate,
946 ioctl_send_response,
947 ioctl_initiate_bus_reset,
948 ioctl_add_descriptor,
949 ioctl_remove_descriptor,
950 ioctl_create_iso_context,
951 ioctl_queue_iso,
952 ioctl_start_iso,
953 ioctl_stop_iso,
Stefan Richtera64408b2007-09-29 10:41:58 +0200954 ioctl_get_cycle_timer,
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400955};
956
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500957static int
958dispatch_ioctl(struct client *client, unsigned int cmd, void __user *arg)
959{
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400960 char buffer[256];
Stefan Richter2dbd7d72008-12-14 21:45:45 +0100961 int ret;
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400962
963 if (_IOC_TYPE(cmd) != '#' ||
964 _IOC_NR(cmd) >= ARRAY_SIZE(ioctl_handlers))
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500965 return -EINVAL;
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400966
967 if (_IOC_DIR(cmd) & _IOC_WRITE) {
Kristian Høgsberg2d826cc2007-05-09 19:23:14 -0400968 if (_IOC_SIZE(cmd) > sizeof(buffer) ||
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400969 copy_from_user(buffer, arg, _IOC_SIZE(cmd)))
970 return -EFAULT;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500971 }
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400972
Stefan Richter2dbd7d72008-12-14 21:45:45 +0100973 ret = ioctl_handlers[_IOC_NR(cmd)](client, buffer);
974 if (ret < 0)
975 return ret;
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400976
977 if (_IOC_DIR(cmd) & _IOC_READ) {
Kristian Høgsberg2d826cc2007-05-09 19:23:14 -0400978 if (_IOC_SIZE(cmd) > sizeof(buffer) ||
Kristian Høgsberg4f259222007-04-30 15:03:13 -0400979 copy_to_user(arg, buffer, _IOC_SIZE(cmd)))
980 return -EFAULT;
981 }
982
Stefan Richter2dbd7d72008-12-14 21:45:45 +0100983 return ret;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500984}
985
986static long
987fw_device_op_ioctl(struct file *file,
988 unsigned int cmd, unsigned long arg)
989{
990 struct client *client = file->private_data;
991
Jay Fenlason551f4cb2008-05-16 11:15:23 -0400992 if (fw_device_is_shutdown(client->device))
993 return -ENODEV;
994
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500995 return dispatch_ioctl(client, cmd, (void __user *) arg);
996}
997
998#ifdef CONFIG_COMPAT
999static long
1000fw_device_op_compat_ioctl(struct file *file,
1001 unsigned int cmd, unsigned long arg)
1002{
1003 struct client *client = file->private_data;
1004
Jay Fenlason551f4cb2008-05-16 11:15:23 -04001005 if (fw_device_is_shutdown(client->device))
1006 return -ENODEV;
1007
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05001008 return dispatch_ioctl(client, cmd, compat_ptr(arg));
1009}
1010#endif
1011
1012static int fw_device_op_mmap(struct file *file, struct vm_area_struct *vma)
1013{
1014 struct client *client = file->private_data;
Kristian Høgsberg9aad8122007-02-16 17:34:38 -05001015 enum dma_data_direction direction;
1016 unsigned long size;
Stefan Richter2dbd7d72008-12-14 21:45:45 +01001017 int page_count, ret;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05001018
Jay Fenlason551f4cb2008-05-16 11:15:23 -04001019 if (fw_device_is_shutdown(client->device))
1020 return -ENODEV;
1021
Kristian Høgsberg9aad8122007-02-16 17:34:38 -05001022 /* FIXME: We could support multiple buffers, but we don't. */
1023 if (client->buffer.pages != NULL)
1024 return -EBUSY;
1025
1026 if (!(vma->vm_flags & VM_SHARED))
1027 return -EINVAL;
1028
1029 if (vma->vm_start & ~PAGE_MASK)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05001030 return -EINVAL;
1031
1032 client->vm_start = vma->vm_start;
Kristian Høgsberg9aad8122007-02-16 17:34:38 -05001033 size = vma->vm_end - vma->vm_start;
1034 page_count = size >> PAGE_SHIFT;
1035 if (size & ~PAGE_MASK)
1036 return -EINVAL;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05001037
Kristian Høgsberg9aad8122007-02-16 17:34:38 -05001038 if (vma->vm_flags & VM_WRITE)
1039 direction = DMA_TO_DEVICE;
1040 else
1041 direction = DMA_FROM_DEVICE;
1042
Stefan Richter2dbd7d72008-12-14 21:45:45 +01001043 ret = fw_iso_buffer_init(&client->buffer, client->device->card,
1044 page_count, direction);
1045 if (ret < 0)
1046 return ret;
Kristian Høgsberg9aad8122007-02-16 17:34:38 -05001047
Stefan Richter2dbd7d72008-12-14 21:45:45 +01001048 ret = fw_iso_buffer_map(&client->buffer, vma);
1049 if (ret < 0)
Kristian Høgsberg9aad8122007-02-16 17:34:38 -05001050 fw_iso_buffer_destroy(&client->buffer, client->device->card);
1051
Stefan Richter2dbd7d72008-12-14 21:45:45 +01001052 return ret;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05001053}
1054
Jay Fenlason45ee3192008-12-21 16:47:17 +01001055static int shutdown_resource(int id, void *p, void *data)
1056{
1057 struct client_resource *r = p;
1058 struct client *client = data;
1059
1060 r->release(client, r);
1061
1062 return 0;
1063}
1064
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05001065static int fw_device_op_release(struct inode *inode, struct file *file)
1066{
1067 struct client *client = file->private_data;
Kristian Høgsberg2603bf22007-03-07 12:12:48 -05001068 struct event *e, *next_e;
Jay Fenlason45ee3192008-12-21 16:47:17 +01001069 unsigned long flags;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05001070
Stefan Richter97811e32008-12-14 19:19:23 +01001071 mutex_lock(&client->device->client_list_mutex);
1072 list_del(&client->link);
1073 mutex_unlock(&client->device->client_list_mutex);
1074
Kristian Høgsberg9aad8122007-02-16 17:34:38 -05001075 if (client->buffer.pages)
1076 fw_iso_buffer_destroy(&client->buffer, client->device->card);
1077
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05001078 if (client->iso_context)
1079 fw_iso_context_destroy(client->iso_context);
1080
Jay Fenlason45ee3192008-12-21 16:47:17 +01001081 /* Freeze client->resource_idr and client->event_list */
1082 spin_lock_irqsave(&client->lock, flags);
1083 client->in_shutdown = true;
1084 spin_unlock_irqrestore(&client->lock, flags);
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +02001085
Jay Fenlason45ee3192008-12-21 16:47:17 +01001086 idr_for_each(&client->resource_idr, shutdown_resource, client);
1087 idr_remove_all(&client->resource_idr);
1088 idr_destroy(&client->resource_idr);
Kristian Høgsberg28cf6a02007-03-07 12:12:50 -05001089
Kristian Høgsberg2603bf22007-03-07 12:12:48 -05001090 list_for_each_entry_safe(e, next_e, &client->event_list, link)
1091 kfree(e);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05001092
Jay Fenlason45ee3192008-12-21 16:47:17 +01001093 /*
1094 * FIXME: client should be reference-counted. It's extremely unlikely
1095 * but there may still be transactions being completed at this point.
1096 */
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05001097 fw_device_put(client->device);
1098 kfree(client);
1099
1100 return 0;
1101}
1102
1103static unsigned int fw_device_op_poll(struct file *file, poll_table * pt)
1104{
1105 struct client *client = file->private_data;
Kristian Høgsberg2603bf22007-03-07 12:12:48 -05001106 unsigned int mask = 0;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05001107
1108 poll_wait(file, &client->wait, pt);
1109
Kristian Høgsberg2603bf22007-03-07 12:12:48 -05001110 if (fw_device_is_shutdown(client->device))
1111 mask |= POLLHUP | POLLERR;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05001112 if (!list_empty(&client->event_list))
Kristian Høgsberg2603bf22007-03-07 12:12:48 -05001113 mask |= POLLIN | POLLRDNORM;
1114
1115 return mask;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05001116}
1117
Stefan Richter21ebcd12007-01-14 15:29:07 +01001118const struct file_operations fw_device_ops = {
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05001119 .owner = THIS_MODULE,
1120 .open = fw_device_op_open,
1121 .read = fw_device_op_read,
1122 .unlocked_ioctl = fw_device_op_ioctl,
1123 .poll = fw_device_op_poll,
1124 .release = fw_device_op_release,
1125 .mmap = fw_device_op_mmap,
1126
1127#ifdef CONFIG_COMPAT
Stefan Richter5af4e5e2007-01-21 20:45:32 +01001128 .compat_ioctl = fw_device_op_compat_ioctl,
Kristian Høgsberg19a15b92006-12-19 19:58:31 -05001129#endif
1130};