core-cdev.c revision 97bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bc
119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg/* -*- c-basic-offset: 8 -*- 219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * 319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * fw-device-cdev.c - Char device for device raw access 419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * 519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * Copyright (C) 2005-2006 Kristian Hoegsberg <krh@bitplanet.net> 619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * 719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * This program is free software; you can redistribute it and/or modify 819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * it under the terms of the GNU General Public License as published by 919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * the Free Software Foundation; either version 2 of the License, or 1019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * (at your option) any later version. 1119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * 1219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * This program is distributed in the hope that it will be useful, 1319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * but WITHOUT ANY WARRANTY; without even the implied warranty of 1419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 1519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * GNU General Public License for more details. 1619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * 1719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * You should have received a copy of the GNU General Public License 1819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * along with this program; if not, write to the Free Software Foundation, 1919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. 2019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg */ 2119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 2219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#include <linux/module.h> 2319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#include <linux/kernel.h> 2419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#include <linux/wait.h> 2519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#include <linux/errno.h> 2619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#include <linux/device.h> 2719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#include <linux/vmalloc.h> 2819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#include <linux/poll.h> 2919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#include <linux/delay.h> 3019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#include <linux/mm.h> 3119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#include <linux/compat.h> 3219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#include <asm/uaccess.h> 3319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#include "fw-transaction.h" 3419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#include "fw-topology.h" 3519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#include "fw-device.h" 3619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#include "fw-device-cdev.h" 3719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 3819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg/* 3919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * todo 4019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * 4119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * - bus resets sends a new packet with new generation and node id 4219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * 4319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg */ 4419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 4519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg/* dequeue_event() just kfree()'s the event, so the event has to be 4619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * the first field in the struct. */ 4719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 4819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstruct event { 4919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct { void *data; size_t size; } v[2]; 5019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct list_head link; 5119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg}; 5219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 5397bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsbergstruct bus_reset { 5497bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg struct event event; 5597bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg struct fw_cdev_event_bus_reset reset; 5697bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg}; 5797bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg 5819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstruct response { 5919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct event event; 6019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_transaction transaction; 6119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct client *client; 6219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_cdev_event_response response; 6319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg}; 6419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 6519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstruct iso_interrupt { 6619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct event event; 6719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_cdev_event_iso_interrupt interrupt; 6819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg}; 6919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 7019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstruct client { 7119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_device *device; 7219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg spinlock_t lock; 7319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct list_head handler_list; 7419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct list_head request_list; 7519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg u32 request_serial; 7619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct list_head event_list; 7719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct semaphore event_list_sem; 7819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg wait_queue_head_t wait; 799aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg 8019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_iso_context *iso_context; 819aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg struct fw_iso_buffer buffer; 829aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg unsigned long vm_start; 8397bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg 8497bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg struct list_head link; 8519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg}; 8619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 8719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic inline void __user * 8819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergu64_to_uptr(__u64 value) 8919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 9019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return (void __user *)(unsigned long)value; 9119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 9219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 9319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic inline __u64 9419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberguptr_to_u64(void __user *ptr) 9519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 9619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return (__u64)(unsigned long)ptr; 9719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 9819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 9919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic int fw_device_op_open(struct inode *inode, struct file *file) 10019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 10119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_device *device; 10219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct client *client; 10397bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg unsigned long flags; 10419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 10519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg device = container_of(inode->i_cdev, struct fw_device, cdev); 10619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 10719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg client = kzalloc(sizeof *client, GFP_KERNEL); 10819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (client == NULL) 10919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -ENOMEM; 11019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 11119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg client->device = fw_device_get(device); 11219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg INIT_LIST_HEAD(&client->event_list); 11319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg sema_init(&client->event_list_sem, 0); 11419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg INIT_LIST_HEAD(&client->handler_list); 11519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg INIT_LIST_HEAD(&client->request_list); 11619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg spin_lock_init(&client->lock); 11719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg init_waitqueue_head(&client->wait); 11819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 11919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg file->private_data = client; 12019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 12197bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg spin_lock_irqsave(&device->card->lock, flags); 12297bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg list_add_tail(&client->link, &device->client_list); 12397bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg spin_unlock_irqrestore(&device->card->lock, flags); 12497bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg 12519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return 0; 12619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 12719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 12819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic void queue_event(struct client *client, struct event *event, 12919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg void *data0, size_t size0, void *data1, size_t size1) 13019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 13119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg unsigned long flags; 13219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 13319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg event->v[0].data = data0; 13419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg event->v[0].size = size0; 13519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg event->v[1].data = data1; 13619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg event->v[1].size = size1; 13719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 13819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg spin_lock_irqsave(&client->lock, flags); 13919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 14019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg list_add_tail(&event->link, &client->event_list); 14119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 14219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg up(&client->event_list_sem); 14319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg wake_up_interruptible(&client->wait); 14419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 14519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg spin_unlock_irqrestore(&client->lock, flags); 14619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 14719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 14819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic int dequeue_event(struct client *client, char __user *buffer, size_t count) 14919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 15019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg unsigned long flags; 15119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct event *event; 15219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg size_t size, total; 15319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg int i, retval = -EFAULT; 15419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 15519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (down_interruptible(&client->event_list_sem) < 0) 15619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EINTR; 15719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 15819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg spin_lock_irqsave(&client->lock, flags); 15919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 16019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg event = container_of(client->event_list.next, struct event, link); 16119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg list_del(&event->link); 16219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 16319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg spin_unlock_irqrestore(&client->lock, flags); 16419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 16519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (buffer == NULL) 16619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg goto out; 16719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 16819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg total = 0; 16919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg for (i = 0; i < ARRAY_SIZE(event->v) && total < count; i++) { 17019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg size = min(event->v[i].size, count - total); 17119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (copy_to_user(buffer + total, event->v[i].data, size)) 17219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg goto out; 17319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg total += size; 17419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg } 17519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg retval = total; 17619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 17719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg out: 17819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg kfree(event); 17919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 18019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return retval; 18119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 18219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 18319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic ssize_t 18419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergfw_device_op_read(struct file *file, 18519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg char __user *buffer, size_t count, loff_t *offset) 18619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 18719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct client *client = file->private_data; 18819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 18919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return dequeue_event(client, buffer, count); 19019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 19119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 19297bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsbergstatic void 19397bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsbergqueue_bus_reset_event(struct client *client) 19497bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg{ 19597bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg struct bus_reset *bus_reset; 19697bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg struct fw_device *device = client->device; 19797bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg struct fw_card *card = device->card; 19897bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg 19997bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg bus_reset = kzalloc(sizeof *bus_reset, GFP_ATOMIC); 20097bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg if (bus_reset == NULL) { 20197bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg fw_notify("Out of memory when allocating bus reset event\n"); 20297bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg return; 20397bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg } 20497bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg 20597bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg bus_reset->reset.type = FW_CDEV_EVENT_BUS_RESET; 20697bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg bus_reset->reset.node_id = device->node_id; 20797bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg bus_reset->reset.local_node_id = card->local_node->node_id; 20897bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg bus_reset->reset.bm_node_id = 0; /* FIXME: We don't track the BM. */ 20997bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg bus_reset->reset.irm_node_id = card->irm_node->node_id; 21097bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg bus_reset->reset.root_node_id = card->root_node->node_id; 21197bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg bus_reset->reset.generation = card->generation; 21297bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg 21397bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg queue_event(client, &bus_reset->event, 21497bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg &bus_reset->reset, sizeof bus_reset->reset, NULL, 0); 21597bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg} 21697bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg 21797bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsbergvoid fw_device_cdev_update(struct fw_device *device) 21897bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg{ 21997bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg struct fw_card *card = device->card; 22097bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg struct client *c; 22197bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg unsigned long flags; 22297bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg 22397bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg spin_lock_irqsave(&card->lock, flags); 22497bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg 22597bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg list_for_each_entry(c, &device->client_list, link) 22697bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg queue_bus_reset_event(c); 22797bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg 22897bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg spin_unlock_irqrestore(&card->lock, flags); 22997bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg} 23097bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg 23119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic int ioctl_config_rom(struct client *client, void __user *arg) 23219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 23319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_cdev_get_config_rom rom; 23419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 23519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg rom.length = client->device->config_rom_length; 23619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg memcpy(rom.data, client->device->config_rom, rom.length * 4); 23719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (copy_to_user(arg, &rom, 23819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg (char *)&rom.data[rom.length] - (char *)&rom)) 23919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EFAULT; 24019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 24119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return 0; 24219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 24319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 24419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic void 24519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergcomplete_transaction(struct fw_card *card, int rcode, 24619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg void *payload, size_t length, void *data) 24719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 24819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct response *response = data; 24919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct client *client = response->client; 25019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 25119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (length < response->response.length) 25219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg response->response.length = length; 25319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (rcode == RCODE_COMPLETE) 25419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg memcpy(response->response.data, payload, 25519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg response->response.length); 25619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 25719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg response->response.type = FW_CDEV_EVENT_RESPONSE; 25819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg response->response.rcode = rcode; 25919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg queue_event(client, &response->event, 26019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg &response->response, sizeof response->response, 26119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg response->response.data, response->response.length); 26219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 26319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 26419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic ssize_t ioctl_send_request(struct client *client, void __user *arg) 26519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 26619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_device *device = client->device; 26719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_cdev_send_request request; 26819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct response *response; 26919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 27019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (copy_from_user(&request, arg, sizeof request)) 27119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EFAULT; 27219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 27319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg /* What is the biggest size we'll accept, really? */ 27419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (request.length > 4096) 27519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EINVAL; 27619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 27719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg response = kmalloc(sizeof *response + request.length, GFP_KERNEL); 27819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (response == NULL) 27919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -ENOMEM; 28019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 28119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg response->client = client; 28219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg response->response.length = request.length; 28319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg response->response.closure = request.closure; 28419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 28519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (request.data && 28619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg copy_from_user(response->response.data, 28719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg u64_to_uptr(request.data), request.length)) { 28819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg kfree(response); 28919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EFAULT; 29019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg } 29119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 29219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg fw_send_request(device->card, &response->transaction, 29319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg request.tcode, 294907293d78872ee492ce6a114258dd853ec5082aeStefan Richter device->node->node_id, 29519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg device->card->generation, 29619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg device->node->max_speed, 29719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg request.offset, 29819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg response->response.data, request.length, 29919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg complete_transaction, response); 30019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 30119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (request.data) 30219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return sizeof request + request.length; 30319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg else 30419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return sizeof request; 30519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 30619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 30719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstruct address_handler { 30819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_address_handler handler; 30919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg __u64 closure; 31019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct client *client; 31119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct list_head link; 31219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg}; 31319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 31419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstruct request { 31519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_request *request; 31619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg void *data; 31719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg size_t length; 31819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg u32 serial; 31919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct list_head link; 32019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg}; 32119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 32219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstruct request_event { 32319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct event event; 32419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_cdev_event_request request; 32519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg}; 32619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 32719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic void 32819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberghandle_request(struct fw_card *card, struct fw_request *r, 32919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg int tcode, int destination, int source, 33019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg int generation, int speed, 33119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg unsigned long long offset, 33219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg void *payload, size_t length, void *callback_data) 33319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 33419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct address_handler *handler = callback_data; 33519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct request *request; 33619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct request_event *e; 33719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg unsigned long flags; 33819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct client *client = handler->client; 33919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 34019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg request = kmalloc(sizeof *request, GFP_ATOMIC); 34119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg e = kmalloc(sizeof *e, GFP_ATOMIC); 34219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (request == NULL || e == NULL) { 34319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg kfree(request); 34419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg kfree(e); 34519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg fw_send_response(card, r, RCODE_CONFLICT_ERROR); 34619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return; 34719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg } 34819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 34919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg request->request = r; 35019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg request->data = payload; 35119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg request->length = length; 35219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 35319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg spin_lock_irqsave(&client->lock, flags); 35419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg request->serial = client->request_serial++; 35519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg list_add_tail(&request->link, &client->request_list); 35619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg spin_unlock_irqrestore(&client->lock, flags); 35719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 35819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg e->request.type = FW_CDEV_EVENT_REQUEST; 35919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg e->request.tcode = tcode; 36019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg e->request.offset = offset; 36119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg e->request.length = length; 36219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg e->request.serial = request->serial; 36319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg e->request.closure = handler->closure; 36419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 36519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg queue_event(client, &e->event, 36619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg &e->request, sizeof e->request, payload, length); 36719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 36819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 36919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic int ioctl_allocate(struct client *client, void __user *arg) 37019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 37119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_cdev_allocate request; 37219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct address_handler *handler; 37319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg unsigned long flags; 37419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_address_region region; 37519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 37619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (copy_from_user(&request, arg, sizeof request)) 37719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EFAULT; 37819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 37919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg handler = kmalloc(sizeof *handler, GFP_KERNEL); 38019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (handler == NULL) 38119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -ENOMEM; 38219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 38319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg region.start = request.offset; 38419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg region.end = request.offset + request.length; 38519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg handler->handler.length = request.length; 38619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg handler->handler.address_callback = handle_request; 38719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg handler->handler.callback_data = handler; 38819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg handler->closure = request.closure; 38919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg handler->client = client; 39019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 39119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (fw_core_add_address_handler(&handler->handler, ®ion) < 0) { 39219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg kfree(handler); 39319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EBUSY; 39419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg } 39519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 39619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg spin_lock_irqsave(&client->lock, flags); 39719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg list_add_tail(&handler->link, &client->handler_list); 39819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg spin_unlock_irqrestore(&client->lock, flags); 39919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 40019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return 0; 40119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 40219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 40319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic int ioctl_send_response(struct client *client, void __user *arg) 40419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 40519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_cdev_send_response request; 40619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct request *r; 40719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg unsigned long flags; 40819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 40919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (copy_from_user(&request, arg, sizeof request)) 41019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EFAULT; 41119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 41219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg spin_lock_irqsave(&client->lock, flags); 41319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg list_for_each_entry(r, &client->request_list, link) { 41419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (r->serial == request.serial) { 41519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg list_del(&r->link); 41619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg break; 41719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg } 41819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg } 41919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg spin_unlock_irqrestore(&client->lock, flags); 42019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 42119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (&r->link == &client->request_list) 42219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EINVAL; 42319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 42419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (request.length < r->length) 42519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg r->length = request.length; 42619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (copy_from_user(r->data, u64_to_uptr(request.data), r->length)) 42719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EFAULT; 42819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 42919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg fw_send_response(client->device->card, r->request, request.rcode); 43019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 43119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg kfree(r); 43219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 43319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return 0; 43419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 43519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 43619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic void 4379b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsbergiso_callback(struct fw_iso_context *context, u32 cycle, 4389b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg size_t header_length, void *header, void *data) 43919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 44019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct client *client = data; 44119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct iso_interrupt *interrupt; 44219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 4439b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg interrupt = kzalloc(sizeof *interrupt + header_length, GFP_ATOMIC); 44419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (interrupt == NULL) 44519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return; 44619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 44719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg interrupt->interrupt.type = FW_CDEV_EVENT_ISO_INTERRUPT; 44819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg interrupt->interrupt.closure = 0; 44919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg interrupt->interrupt.cycle = cycle; 4509b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg interrupt->interrupt.header_length = header_length; 4519b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg memcpy(interrupt->interrupt.header, header, header_length); 45219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg queue_event(client, &interrupt->event, 4539b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg &interrupt->interrupt, 4549b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg sizeof interrupt->interrupt + header_length, NULL, 0); 45519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 45619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 45719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic int ioctl_create_iso_context(struct client *client, void __user *arg) 45819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 45919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_cdev_create_iso_context request; 46019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 46119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (copy_from_user(&request, arg, sizeof request)) 46219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EFAULT; 46319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 464295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg if (request.type > FW_ISO_CONTEXT_RECEIVE) 465295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg return -EINVAL; 466295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg 46721efb3cfc6ed49991638000f58bb23b838c76e25Kristian Høgsberg if (request.channel > 63) 46821efb3cfc6ed49991638000f58bb23b838c76e25Kristian Høgsberg return -EINVAL; 46921efb3cfc6ed49991638000f58bb23b838c76e25Kristian Høgsberg 47098b6cbe83b6e8db54638746c9040c7962d96b322Kristian Høgsberg if (request.sync > 15) 47198b6cbe83b6e8db54638746c9040c7962d96b322Kristian Høgsberg return -EINVAL; 47298b6cbe83b6e8db54638746c9040c7962d96b322Kristian Høgsberg 47398b6cbe83b6e8db54638746c9040c7962d96b322Kristian Høgsberg if (request.tags == 0 || request.tags > 15) 47498b6cbe83b6e8db54638746c9040c7962d96b322Kristian Høgsberg return -EINVAL; 47598b6cbe83b6e8db54638746c9040c7962d96b322Kristian Høgsberg 47621efb3cfc6ed49991638000f58bb23b838c76e25Kristian Høgsberg if (request.speed > SCODE_3200) 47721efb3cfc6ed49991638000f58bb23b838c76e25Kristian Høgsberg return -EINVAL; 47821efb3cfc6ed49991638000f58bb23b838c76e25Kristian Høgsberg 47919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg client->iso_context = fw_iso_context_create(client->device->card, 480295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg request.type, 48121efb3cfc6ed49991638000f58bb23b838c76e25Kristian Høgsberg request.channel, 48221efb3cfc6ed49991638000f58bb23b838c76e25Kristian Høgsberg request.speed, 483295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg request.header_size, 48498b6cbe83b6e8db54638746c9040c7962d96b322Kristian Høgsberg request.sync, 48598b6cbe83b6e8db54638746c9040c7962d96b322Kristian Høgsberg request.tags, 48619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg iso_callback, client); 48719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (IS_ERR(client->iso_context)) 48819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return PTR_ERR(client->iso_context); 48919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 49019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return 0; 49119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 49219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 49319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic int ioctl_queue_iso(struct client *client, void __user *arg) 49419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 49519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_cdev_queue_iso request; 49619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_cdev_iso_packet __user *p, *end, *next; 4979b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg struct fw_iso_context *ctx = client->iso_context; 498295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg unsigned long payload, payload_end, header_length; 49919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg int count; 50019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct { 50119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct fw_iso_packet packet; 50219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg u8 header[256]; 50319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg } u; 50419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 5059b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg if (ctx == NULL) 50619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EINVAL; 50719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (copy_from_user(&request, arg, sizeof request)) 50819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EFAULT; 50919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 51019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg /* If the user passes a non-NULL data pointer, has mmap()'ed 51119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * the iso buffer, and the pointer points inside the buffer, 51219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * we setup the payload pointers accordingly. Otherwise we 5139aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg * set them both to 0, which will still let packets with 51419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * payload_length == 0 through. In other words, if no packets 51519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * use the indirect payload, the iso buffer need not be mapped 51619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * and the request.data pointer is ignored.*/ 51719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 5189aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg payload = (unsigned long)request.data - client->vm_start; 5199aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg payload_end = payload + (client->buffer.page_count << PAGE_SHIFT); 5209aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg if (request.data == 0 || client->buffer.pages == NULL || 5219aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg payload >= payload_end) { 5229aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg payload = 0; 5239aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg payload_end = 0; 52419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg } 52519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 52619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (!access_ok(VERIFY_READ, request.packets, request.size)) 52719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EFAULT; 52819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 52919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg p = (struct fw_cdev_iso_packet __user *)u64_to_uptr(request.packets); 53019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg end = (void __user *)p + request.size; 53119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg count = 0; 53219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg while (p < end) { 53319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (__copy_from_user(&u.packet, p, sizeof *p)) 53419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EFAULT; 535295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg 5369b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg if (ctx->type == FW_ISO_CONTEXT_TRANSMIT) { 537295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg header_length = u.packet.header_length; 538295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg } else { 539295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg /* We require that header_length is a multiple of 540295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg * the fixed header size, ctx->header_size */ 5419b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg if (ctx->header_size == 0) { 5429b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg if (u.packet.header_length > 0) 5439b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg return -EINVAL; 5449b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg } else if (u.packet.header_length % ctx->header_size != 0) { 545295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg return -EINVAL; 5469b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg } 547295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg header_length = 0; 548295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg } 549295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg 55019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg next = (struct fw_cdev_iso_packet __user *) 551295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg &p->header[header_length / 4]; 55219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (next > end) 55319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EINVAL; 55419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (__copy_from_user 555295e3feb92e5073ec32a3c626302d4b92c4c8a95Kristian Høgsberg (u.packet.header, p->header, header_length)) 55619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EFAULT; 55798b6cbe83b6e8db54638746c9040c7962d96b322Kristian Høgsberg if (u.packet.skip && ctx->type == FW_ISO_CONTEXT_TRANSMIT && 55819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg u.packet.header_length + u.packet.payload_length > 0) 55919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EINVAL; 56019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (payload + u.packet.payload_length > payload_end) 56119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EINVAL; 56219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 5639b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg if (fw_iso_context_queue(ctx, &u.packet, 5649b32d5f3074e9b1afaa39a360a59fd77a2214783Kristian Høgsberg &client->buffer, payload)) 56519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg break; 56619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 56719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg p = next; 56819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg payload += u.packet.payload_length; 56919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg count++; 57019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg } 57119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 57219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg request.size -= uptr_to_u64(p) - request.packets; 57319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg request.packets = uptr_to_u64(p); 5749aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg request.data = client->vm_start + payload; 57519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 57619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (copy_to_user(arg, &request, sizeof request)) 57719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EFAULT; 57819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 57919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return count; 58019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 58119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 58269cdb7268ca2e644665dae8ea26e35ce4e96679cKristian Høgsbergstatic int ioctl_start_iso(struct client *client, void __user *arg) 58319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 58469cdb7268ca2e644665dae8ea26e35ce4e96679cKristian Høgsberg struct fw_cdev_start_iso request; 58519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 58619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (copy_from_user(&request, arg, sizeof request)) 58719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EFAULT; 58819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 58921efb3cfc6ed49991638000f58bb23b838c76e25Kristian Høgsberg return fw_iso_context_start(client->iso_context, request.cycle); 59019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 59119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 592b82956685aab4a9d333714300eb8a86fed6c9ab3Kristian Høgsbergstatic int ioctl_stop_iso(struct client *client, void __user *arg) 593b82956685aab4a9d333714300eb8a86fed6c9ab3Kristian Høgsberg{ 594b82956685aab4a9d333714300eb8a86fed6c9ab3Kristian Høgsberg return fw_iso_context_stop(client->iso_context); 595b82956685aab4a9d333714300eb8a86fed6c9ab3Kristian Høgsberg} 596b82956685aab4a9d333714300eb8a86fed6c9ab3Kristian Høgsberg 59719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic int 59819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergdispatch_ioctl(struct client *client, unsigned int cmd, void __user *arg) 59919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 60019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg switch (cmd) { 60119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg case FW_CDEV_IOC_GET_CONFIG_ROM: 60219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return ioctl_config_rom(client, arg); 60319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg case FW_CDEV_IOC_SEND_REQUEST: 60419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return ioctl_send_request(client, arg); 60519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg case FW_CDEV_IOC_ALLOCATE: 60619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return ioctl_allocate(client, arg); 60719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg case FW_CDEV_IOC_SEND_RESPONSE: 60819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return ioctl_send_response(client, arg); 60919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg case FW_CDEV_IOC_CREATE_ISO_CONTEXT: 61019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return ioctl_create_iso_context(client, arg); 61119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg case FW_CDEV_IOC_QUEUE_ISO: 61219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return ioctl_queue_iso(client, arg); 61369cdb7268ca2e644665dae8ea26e35ce4e96679cKristian Høgsberg case FW_CDEV_IOC_START_ISO: 61469cdb7268ca2e644665dae8ea26e35ce4e96679cKristian Høgsberg return ioctl_start_iso(client, arg); 615b82956685aab4a9d333714300eb8a86fed6c9ab3Kristian Høgsberg case FW_CDEV_IOC_STOP_ISO: 616b82956685aab4a9d333714300eb8a86fed6c9ab3Kristian Høgsberg return ioctl_stop_iso(client, arg); 61719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg default: 61819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EINVAL; 61919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg } 62019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 62119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 62219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic long 62319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergfw_device_op_ioctl(struct file *file, 62419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg unsigned int cmd, unsigned long arg) 62519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 62619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct client *client = file->private_data; 62719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 62819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return dispatch_ioctl(client, cmd, (void __user *) arg); 62919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 63019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 63119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#ifdef CONFIG_COMPAT 63219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic long 63319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergfw_device_op_compat_ioctl(struct file *file, 63419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg unsigned int cmd, unsigned long arg) 63519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 63619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct client *client = file->private_data; 63719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 63819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return dispatch_ioctl(client, cmd, compat_ptr(arg)); 63919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 64019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#endif 64119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 64219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic int fw_device_op_mmap(struct file *file, struct vm_area_struct *vma) 64319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 64419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct client *client = file->private_data; 6459aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg enum dma_data_direction direction; 6469aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg unsigned long size; 6479aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg int page_count, retval; 6489aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg 6499aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg /* FIXME: We could support multiple buffers, but we don't. */ 6509aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg if (client->buffer.pages != NULL) 6519aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg return -EBUSY; 6529aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg 6539aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg if (!(vma->vm_flags & VM_SHARED)) 6549aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg return -EINVAL; 65519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 6569aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg if (vma->vm_start & ~PAGE_MASK) 65719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return -EINVAL; 65819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 65919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg client->vm_start = vma->vm_start; 6609aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg size = vma->vm_end - vma->vm_start; 6619aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg page_count = size >> PAGE_SHIFT; 6629aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg if (size & ~PAGE_MASK) 6639aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg return -EINVAL; 6649aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg 6659aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg if (vma->vm_flags & VM_WRITE) 6669aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg direction = DMA_TO_DEVICE; 6679aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg else 6689aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg direction = DMA_FROM_DEVICE; 6699aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg 6709aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg retval = fw_iso_buffer_init(&client->buffer, client->device->card, 6719aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg page_count, direction); 6729aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg if (retval < 0) 6739aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg return retval; 67419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 6759aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg retval = fw_iso_buffer_map(&client->buffer, vma); 6769aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg if (retval < 0) 6779aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg fw_iso_buffer_destroy(&client->buffer, client->device->card); 6789aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg 6799aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg return retval; 68019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 68119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 68219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic int fw_device_op_release(struct inode *inode, struct file *file) 68319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 68419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct client *client = file->private_data; 68519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct address_handler *h, *next; 68619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct request *r, *next_r; 68797bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg unsigned long flags; 68819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 6899aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg if (client->buffer.pages) 6909aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg fw_iso_buffer_destroy(&client->buffer, client->device->card); 6919aad8125389a7a2990dee72d7892e22330a945ebKristian Høgsberg 69219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (client->iso_context) 69319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg fw_iso_context_destroy(client->iso_context); 69419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 69519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg list_for_each_entry_safe(h, next, &client->handler_list, link) { 69619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg fw_core_remove_address_handler(&h->handler); 69719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg kfree(h); 69819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg } 69919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 70019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg list_for_each_entry_safe(r, next_r, &client->request_list, link) { 70119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg fw_send_response(client->device->card, r->request, 70219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg RCODE_CONFLICT_ERROR); 70319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg kfree(r); 70419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg } 70519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 70619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg /* TODO: wait for all transactions to finish so 70719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * complete_transaction doesn't try to queue up responses 70819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg * after we free client. */ 70919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg while (!list_empty(&client->event_list)) 71019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg dequeue_event(client, NULL, 0); 71119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 71297bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg spin_lock_irqsave(&client->device->card->lock, flags); 71397bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg list_del(&client->link); 71497bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg spin_unlock_irqrestore(&client->device->card->lock, flags); 71597bd9efa5a4d8a70b3bafe0d1e3e1a814fdac5bcKristian Høgsberg 71619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg fw_device_put(client->device); 71719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg kfree(client); 71819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 71919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return 0; 72019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 72119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 72219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsbergstatic unsigned int fw_device_op_poll(struct file *file, poll_table * pt) 72319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg{ 72419a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg struct client *client = file->private_data; 72519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 72619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg poll_wait(file, &client->wait, pt); 72719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 72819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg if (!list_empty(&client->event_list)) 72919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return POLLIN | POLLRDNORM; 73019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg else 73119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg return 0; 73219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg} 73319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 73421ebcd1224d05c8673053e1e93ab9ec7ef3e0b84Stefan Richterconst struct file_operations fw_device_ops = { 73519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg .owner = THIS_MODULE, 73619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg .open = fw_device_op_open, 73719a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg .read = fw_device_op_read, 73819a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg .unlocked_ioctl = fw_device_op_ioctl, 73919a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg .poll = fw_device_op_poll, 74019a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg .release = fw_device_op_release, 74119a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg .mmap = fw_device_op_mmap, 74219a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg 74319a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#ifdef CONFIG_COMPAT 7445af4e5eab30d481f76b89a2167c873dfad960acbStefan Richter .compat_ioctl = fw_device_op_compat_ioctl, 74519a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg#endif 74619a15b937b26638933307bb02f7b1801310d6eb2Kristian Høgsberg}; 747