diff options
Diffstat (limited to 'drivers/firewire/fw-device-cdev.c')
| -rw-r--r-- | drivers/firewire/fw-device-cdev.c | 65 |
1 files changed, 48 insertions, 17 deletions
diff --git a/drivers/firewire/fw-device-cdev.c b/drivers/firewire/fw-device-cdev.c index 79e095ea552d..d9f3bb2be1c2 100644 --- a/drivers/firewire/fw-device-cdev.c +++ b/drivers/firewire/fw-device-cdev.c @@ -68,6 +68,7 @@ struct iso_interrupt { }; struct client { + u32 version; struct fw_device *device; spinlock_t lock; struct list_head handler_list; @@ -190,11 +191,25 @@ fw_device_op_read(struct file *file, } static void +fill_bus_reset_event(struct fw_cdev_event_bus_reset *event, + struct fw_device *device) +{ + struct fw_card *card = device->card; + + event->type = FW_CDEV_EVENT_BUS_RESET; + event->node_id = device->node_id; + event->local_node_id = card->local_node->node_id; + event->bm_node_id = 0; /* FIXME: We don't track the BM. */ + event->irm_node_id = card->irm_node->node_id; + event->root_node_id = card->root_node->node_id; + event->generation = card->generation; +} + +static void queue_bus_reset_event(struct client *client) { struct bus_reset *bus_reset; struct fw_device *device = client->device; - struct fw_card *card = device->card; bus_reset = kzalloc(sizeof *bus_reset, GFP_ATOMIC); if (bus_reset == NULL) { @@ -202,13 +217,7 @@ queue_bus_reset_event(struct client *client) return; } - bus_reset->reset.type = FW_CDEV_EVENT_BUS_RESET; - bus_reset->reset.node_id = device->node_id; - bus_reset->reset.local_node_id = card->local_node->node_id; - bus_reset->reset.bm_node_id = 0; /* FIXME: We don't track the BM. */ - bus_reset->reset.irm_node_id = card->irm_node->node_id; - bus_reset->reset.root_node_id = card->root_node->node_id; - bus_reset->reset.generation = card->generation; + fill_bus_reset_event(&bus_reset->reset, device); queue_event(client, &bus_reset->event, &bus_reset->reset, sizeof bus_reset->reset, NULL, 0); @@ -228,14 +237,36 @@ void fw_device_cdev_update(struct fw_device *device) spin_unlock_irqrestore(&card->lock, flags); } -static int ioctl_config_rom(struct client *client, void __user *arg) +static int ioctl_get_info(struct client *client, void __user *arg) { - struct fw_cdev_get_config_rom rom; + struct fw_cdev_get_info get_info; + struct fw_cdev_event_bus_reset bus_reset; + + if (copy_from_user(&get_info, arg, sizeof get_info)) + return -EFAULT; + + client->version = get_info.version; + get_info.version = FW_CDEV_VERSION; + + if (get_info.rom != 0) { + void __user *uptr = u64_to_uptr(get_info.rom); + size_t length = min(get_info.rom_length, + client->device->config_rom_length * 4); + + if (copy_to_user(uptr, client->device->config_rom, length)) + return -EFAULT; + } + get_info.rom_length = client->device->config_rom_length * 4; + + if (get_info.bus_reset != 0) { + void __user *uptr = u64_to_uptr(get_info.bus_reset); + + fill_bus_reset_event(&bus_reset, client->device); + if (copy_to_user(uptr, &bus_reset, sizeof bus_reset)) + return -EFAULT; + } - rom.length = client->device->config_rom_length; - memcpy(rom.data, client->device->config_rom, rom.length * 4); - if (copy_to_user(arg, &rom, - (char *)&rom.data[rom.length] - (char *)&rom)) + if (copy_to_user(arg, &get_info, sizeof get_info)) return -EFAULT; return 0; @@ -290,7 +321,7 @@ static ssize_t ioctl_send_request(struct client *client, void __user *arg) } fw_send_request(device->card, &response->transaction, - request.tcode, + request.tcode & 0x1f, device->node->node_id, device->card->generation, device->node->max_speed, @@ -611,8 +642,8 @@ static int dispatch_ioctl(struct client *client, unsigned int cmd, void __user *arg) { switch (cmd) { - case FW_CDEV_IOC_GET_CONFIG_ROM: - return ioctl_config_rom(client, arg); + case FW_CDEV_IOC_GET_INFO: + return ioctl_get_info(client, arg); case FW_CDEV_IOC_SEND_REQUEST: return ioctl_send_request(client, arg); case FW_CDEV_IOC_ALLOCATE: |
