| /* | |
| * IEEE 1394 for Linux | |
| * | |
| * Low level (host adapter) management. | |
| * | |
| * Copyright (C) 1999 Andreas E. Bombe | |
| * Copyright (C) 1999 Emanuel Pirker | |
| * | |
| * This code is licensed under the GPL. See the file COPYING in the root | |
| * directory of the kernel sources for details. | |
| */ | |
| #include <linux/module.h> | |
| #include <linux/types.h> | |
| #include <linux/list.h> | |
| #include <linux/init.h> | |
| #include <linux/slab.h> | |
| #include <linux/timer.h> | |
| #include <linux/jiffies.h> | |
| #include <linux/mutex.h> | |
| #include "csr1212.h" | |
| #include "ieee1394.h" | |
| #include "ieee1394_types.h" | |
| #include "hosts.h" | |
| #include "ieee1394_core.h" | |
| #include "highlevel.h" | |
| #include "nodemgr.h" | |
| #include "csr.h" | |
| #include "config_roms.h" | |
| static void delayed_reset_bus(struct work_struct *work) | |
| { | |
| struct hpsb_host *host = | |
| container_of(work, struct hpsb_host, delayed_reset.work); | |
| u8 generation = host->csr.generation + 1; | |
| /* The generation field rolls over to 2 rather than 0 per IEEE | |
| * 1394a-2000. */ | |
| if (generation > 0xf || generation < 2) | |
| generation = 2; | |
| csr_set_bus_info_generation(host->csr.rom, generation); | |
| if (csr1212_generate_csr_image(host->csr.rom) != CSR1212_SUCCESS) { | |
| /* CSR image creation failed. | |
| * Reset generation field and do not issue a bus reset. */ | |
| csr_set_bus_info_generation(host->csr.rom, | |
| host->csr.generation); | |
| return; | |
| } | |
| host->csr.generation = generation; | |
| host->update_config_rom = 0; | |
| if (host->driver->set_hw_config_rom) | |
| host->driver->set_hw_config_rom(host, | |
| host->csr.rom->bus_info_data); | |
| host->csr.gen_timestamp[host->csr.generation] = jiffies; | |
| hpsb_reset_bus(host, SHORT_RESET); | |
| } | |
| static int dummy_transmit_packet(struct hpsb_host *h, struct hpsb_packet *p) | |
| { | |
| return 0; | |
| } | |
| static int dummy_devctl(struct hpsb_host *h, enum devctl_cmd c, int arg) | |
| { | |
| return -1; | |
| } | |
| static int dummy_isoctl(struct hpsb_iso *iso, enum isoctl_cmd command, | |
| unsigned long arg) | |
| { | |
| return -1; | |
| } | |
| static struct hpsb_host_driver dummy_driver = { | |
| .transmit_packet = dummy_transmit_packet, | |
| .devctl = dummy_devctl, | |
| .isoctl = dummy_isoctl | |
| }; | |
| static int alloc_hostnum_cb(struct hpsb_host *host, void *__data) | |
| { | |
| int *hostnum = __data; | |
| if (host->id == *hostnum) | |
| return 1; | |
| return 0; | |
| } | |
| static DEFINE_MUTEX(host_num_alloc); | |
| /** | |
| * hpsb_alloc_host - allocate a new host controller. | |
| * @drv: the driver that will manage the host controller | |
| * @extra: number of extra bytes to allocate for the driver | |
| * | |
| * Allocate a &hpsb_host and initialize the general subsystem specific | |
| * fields. If the driver needs to store per host data, as drivers | |
| * usually do, the amount of memory required can be specified by the | |
| * @extra parameter. Once allocated, the driver should initialize the | |
| * driver specific parts, enable the controller and make it available | |
| * to the general subsystem using hpsb_add_host(). | |
| * | |
| * Return Value: a pointer to the &hpsb_host if successful, %NULL if | |
| * no memory was available. | |
| */ | |
| struct hpsb_host *hpsb_alloc_host(struct hpsb_host_driver *drv, size_t extra, | |
| struct device *dev) | |
| { | |
| struct hpsb_host *h; | |
| int i; | |
| int hostnum = 0; | |
| h = kzalloc(sizeof(*h) + extra, GFP_KERNEL); | |
| if (!h) | |
| return NULL; | |
| h->csr.rom = csr1212_create_csr(&csr_bus_ops, CSR_BUS_INFO_SIZE, h); | |
| if (!h->csr.rom) | |
| goto fail; | |
| h->hostdata = h + 1; | |
| h->driver = drv; | |
| INIT_LIST_HEAD(&h->pending_packets); | |
| INIT_LIST_HEAD(&h->addr_space); | |
| for (i = 2; i < 16; i++) | |
| h->csr.gen_timestamp[i] = jiffies - 60 * HZ; | |
| atomic_set(&h->generation, 0); | |
| INIT_DELAYED_WORK(&h->delayed_reset, delayed_reset_bus); | |
| init_timer(&h->timeout); | |
| h->timeout.data = (unsigned long) h; | |
| h->timeout.function = abort_timedouts; | |
| h->timeout_interval = HZ / 20; /* 50ms, half of minimum SPLIT_TIMEOUT */ | |
| h->topology_map = h->csr.topology_map + 3; | |
| h->speed_map = (u8 *)(h->csr.speed_map + 2); | |
| mutex_lock(&host_num_alloc); | |
| while (nodemgr_for_each_host(&hostnum, alloc_hostnum_cb)) | |
| hostnum++; | |
| mutex_unlock(&host_num_alloc); | |
| h->id = hostnum; | |
| memcpy(&h->device, &nodemgr_dev_template_host, sizeof(h->device)); | |
| h->device.parent = dev; | |
| set_dev_node(&h->device, dev_to_node(dev)); | |
| dev_set_name(&h->device, "fw-host%d", h->id); | |
| h->host_dev.parent = &h->device; | |
| h->host_dev.class = &hpsb_host_class; | |
| dev_set_name(&h->host_dev, "fw-host%d", h->id); | |
| if (device_register(&h->device)) | |
| goto fail; | |
| if (device_register(&h->host_dev)) { | |
| device_unregister(&h->device); | |
| goto fail; | |
| } | |
| get_device(&h->device); | |
| return h; | |
| fail: | |
| kfree(h); | |
| return NULL; | |
| } | |
| int hpsb_add_host(struct hpsb_host *host) | |
| { | |
| if (hpsb_default_host_entry(host)) | |
| return -ENOMEM; | |
| highlevel_add_host(host); | |
| return 0; | |
| } | |
| void hpsb_resume_host(struct hpsb_host *host) | |
| { | |
| if (host->driver->set_hw_config_rom) | |
| host->driver->set_hw_config_rom(host, | |
| host->csr.rom->bus_info_data); | |
| host->driver->devctl(host, RESET_BUS, SHORT_RESET); | |
| } | |
| void hpsb_remove_host(struct hpsb_host *host) | |
| { | |
| host->is_shutdown = 1; | |
| cancel_delayed_work(&host->delayed_reset); | |
| flush_scheduled_work(); | |
| host->driver = &dummy_driver; | |
| highlevel_remove_host(host); | |
| device_unregister(&host->host_dev); | |
| device_unregister(&host->device); | |
| } | |
| /** | |
| * hpsb_update_config_rom_image - updates configuration ROM image of a host | |
| * | |
| * Updates the configuration ROM image of a host. rom_version must be the | |
| * current version, otherwise it will fail with return value -1. If this | |
| * host does not support config-rom-update, it will return -%EINVAL. | |
| * Return value 0 indicates success. | |
| */ | |
| int hpsb_update_config_rom_image(struct hpsb_host *host) | |
| { | |
| unsigned long reset_delay; | |
| int next_gen = host->csr.generation + 1; | |
| if (!host->update_config_rom) | |
| return -EINVAL; | |
| if (next_gen > 0xf) | |
| next_gen = 2; | |
| /* Stop the delayed interrupt, we're about to change the config rom and | |
| * it would be a waste to do a bus reset twice. */ | |
| cancel_delayed_work(&host->delayed_reset); | |
| /* IEEE 1394a-2000 prohibits using the same generation number | |
| * twice in a 60 second period. */ | |
| if (time_before(jiffies, host->csr.gen_timestamp[next_gen] + 60 * HZ)) | |
| /* Wait 60 seconds from the last time this generation number was | |
| * used. */ | |
| reset_delay = | |
| (60 * HZ) + host->csr.gen_timestamp[next_gen] - jiffies; | |
| else | |
| /* Wait 1 second in case some other code wants to change the | |
| * Config ROM in the near future. */ | |
| reset_delay = HZ; | |
| PREPARE_DELAYED_WORK(&host->delayed_reset, delayed_reset_bus); | |
| schedule_delayed_work(&host->delayed_reset, reset_delay); | |
| return 0; | |
| } |