| /* | |
| * IEEE 1394 for Linux | |
| * | |
| * ConfigROM entries | |
| * | |
| * Copyright (C) 2004 Ben Collins | |
| * | |
| * This code is licensed under the GPL. See the file COPYING in the root | |
| * directory of the kernel sources for details. | |
| */ | |
| #include <linux/types.h> | |
| #include "csr1212.h" | |
| #include "ieee1394.h" | |
| #include "ieee1394_types.h" | |
| #include "hosts.h" | |
| #include "ieee1394_core.h" | |
| #include "highlevel.h" | |
| #include "csr.h" | |
| #include "config_roms.h" | |
| struct hpsb_config_rom_entry { | |
| const char *name; | |
| /* Base initialization, called at module load */ | |
| int (*init)(void); | |
| /* Add entry to specified host */ | |
| int (*add)(struct hpsb_host *host); | |
| /* Remove entry from specified host */ | |
| void (*remove)(struct hpsb_host *host); | |
| /* Cleanup called at module exit */ | |
| void (*cleanup)(void); | |
| /* The flag added to host->config_roms */ | |
| unsigned int flag; | |
| }; | |
| int hpsb_default_host_entry(struct hpsb_host *host) | |
| { | |
| struct csr1212_keyval *root; | |
| struct csr1212_keyval *vend_id = NULL; | |
| struct csr1212_keyval *text = NULL; | |
| char csr_name[128]; | |
| int ret; | |
| sprintf(csr_name, "Linux - %s", host->driver->name); | |
| root = host->csr.rom->root_kv; | |
| vend_id = csr1212_new_immediate(CSR1212_KV_ID_VENDOR, host->csr.guid_hi >> 8); | |
| text = csr1212_new_string_descriptor_leaf(csr_name); | |
| if (!vend_id || !text) { | |
| if (vend_id) | |
| csr1212_release_keyval(vend_id); | |
| if (text) | |
| csr1212_release_keyval(text); | |
| csr1212_destroy_csr(host->csr.rom); | |
| return -ENOMEM; | |
| } | |
| ret = csr1212_associate_keyval(vend_id, text); | |
| csr1212_release_keyval(text); | |
| ret |= csr1212_attach_keyval_to_directory(root, vend_id); | |
| csr1212_release_keyval(vend_id); | |
| if (ret != CSR1212_SUCCESS) { | |
| csr1212_destroy_csr(host->csr.rom); | |
| return -ENOMEM; | |
| } | |
| host->update_config_rom = 1; | |
| return 0; | |
| } | |
| #ifdef CONFIG_IEEE1394_CONFIG_ROM_IP1394 | |
| #include "eth1394.h" | |
| static struct csr1212_keyval *ip1394_ud; | |
| static int config_rom_ip1394_init(void) | |
| { | |
| struct csr1212_keyval *spec_id = NULL; | |
| struct csr1212_keyval *spec_desc = NULL; | |
| struct csr1212_keyval *ver = NULL; | |
| struct csr1212_keyval *ver_desc = NULL; | |
| int ret = -ENOMEM; | |
| ip1394_ud = csr1212_new_directory(CSR1212_KV_ID_UNIT); | |
| spec_id = csr1212_new_immediate(CSR1212_KV_ID_SPECIFIER_ID, | |
| ETHER1394_GASP_SPECIFIER_ID); | |
| spec_desc = csr1212_new_string_descriptor_leaf("IANA"); | |
| ver = csr1212_new_immediate(CSR1212_KV_ID_VERSION, | |
| ETHER1394_GASP_VERSION); | |
| ver_desc = csr1212_new_string_descriptor_leaf("IPv4"); | |
| if (!ip1394_ud || !spec_id || !spec_desc || !ver || !ver_desc) | |
| goto ip1394_fail; | |
| if (csr1212_associate_keyval(spec_id, spec_desc) == CSR1212_SUCCESS && | |
| csr1212_associate_keyval(ver, ver_desc) == CSR1212_SUCCESS && | |
| csr1212_attach_keyval_to_directory(ip1394_ud, spec_id) == CSR1212_SUCCESS && | |
| csr1212_attach_keyval_to_directory(ip1394_ud, ver) == CSR1212_SUCCESS) | |
| ret = 0; | |
| ip1394_fail: | |
| if (ret && ip1394_ud) { | |
| csr1212_release_keyval(ip1394_ud); | |
| ip1394_ud = NULL; | |
| } | |
| if (spec_id) | |
| csr1212_release_keyval(spec_id); | |
| if (spec_desc) | |
| csr1212_release_keyval(spec_desc); | |
| if (ver) | |
| csr1212_release_keyval(ver); | |
| if (ver_desc) | |
| csr1212_release_keyval(ver_desc); | |
| return ret; | |
| } | |
| static void config_rom_ip1394_cleanup(void) | |
| { | |
| if (ip1394_ud) { | |
| csr1212_release_keyval(ip1394_ud); | |
| ip1394_ud = NULL; | |
| } | |
| } | |
| static int config_rom_ip1394_add(struct hpsb_host *host) | |
| { | |
| if (!ip1394_ud) | |
| return -ENODEV; | |
| if (csr1212_attach_keyval_to_directory(host->csr.rom->root_kv, | |
| ip1394_ud) != CSR1212_SUCCESS) | |
| return -ENOMEM; | |
| return 0; | |
| } | |
| static void config_rom_ip1394_remove(struct hpsb_host *host) | |
| { | |
| csr1212_detach_keyval_from_directory(host->csr.rom->root_kv, ip1394_ud); | |
| } | |
| static struct hpsb_config_rom_entry ip1394_entry = { | |
| .name = "ip1394", | |
| .init = config_rom_ip1394_init, | |
| .add = config_rom_ip1394_add, | |
| .remove = config_rom_ip1394_remove, | |
| .cleanup = config_rom_ip1394_cleanup, | |
| .flag = HPSB_CONFIG_ROM_ENTRY_IP1394, | |
| }; | |
| #endif /* CONFIG_IEEE1394_CONFIG_ROM_IP1394 */ | |
| static struct hpsb_config_rom_entry *const config_rom_entries[] = { | |
| #ifdef CONFIG_IEEE1394_CONFIG_ROM_IP1394 | |
| &ip1394_entry, | |
| #endif | |
| NULL, | |
| }; | |
| int hpsb_init_config_roms(void) | |
| { | |
| int i, error = 0; | |
| for (i = 0; config_rom_entries[i]; i++) { | |
| if (!config_rom_entries[i]->init) | |
| continue; | |
| if (config_rom_entries[i]->init()) { | |
| HPSB_ERR("Failed to initialize config rom entry `%s'", | |
| config_rom_entries[i]->name); | |
| error = -1; | |
| } else | |
| HPSB_DEBUG("Initialized config rom entry `%s'", | |
| config_rom_entries[i]->name); | |
| } | |
| return error; | |
| } | |
| void hpsb_cleanup_config_roms(void) | |
| { | |
| int i; | |
| for (i = 0; config_rom_entries[i]; i++) { | |
| if (config_rom_entries[i]->cleanup) | |
| config_rom_entries[i]->cleanup(); | |
| } | |
| } | |
| int hpsb_add_extra_config_roms(struct hpsb_host *host) | |
| { | |
| int i, error = 0; | |
| for (i = 0; config_rom_entries[i]; i++) { | |
| if (config_rom_entries[i]->add(host)) { | |
| HPSB_ERR("fw-host%d: Failed to attach config rom entry `%s'", | |
| host->id, config_rom_entries[i]->name); | |
| error = -1; | |
| } else { | |
| host->config_roms |= config_rom_entries[i]->flag; | |
| host->update_config_rom = 1; | |
| } | |
| } | |
| return error; | |
| } | |
| void hpsb_remove_extra_config_roms(struct hpsb_host *host) | |
| { | |
| int i; | |
| for (i = 0; config_rom_entries[i]; i++) { | |
| if (!(host->config_roms & config_rom_entries[i]->flag)) | |
| continue; | |
| config_rom_entries[i]->remove(host); | |
| host->config_roms &= ~config_rom_entries[i]->flag; | |
| host->update_config_rom = 1; | |
| } | |
| } |