1 files changed, 236 insertions, 0 deletions

diff --git a/drivers/ieee1394/config_roms.c b/drivers/ieee1394/config_roms.c
new file mode 100644
index 000000000000..1017fd717248
--- /dev/null
+++ b/drivers/ieee1394/config_roms.c
@@ -0,0 +1,236 @@
+/*
+ * 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/config.h>
+#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;
+        }
+}