Subversion Repositories test_project

/*

 * 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);

        /* Cleanup called at module exit */

        void (*cleanup)(void);

        /* The flag added to host->config_roms */

        unsigned int flag;

};

/* The default host entry. This must succeed. */

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;

        }

        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_ETH1394_ROM_ENTRY

#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;

        csr1212_associate_keyval(spec_id, spec_desc);

        csr1212_associate_keyval(ver, ver_desc);

        if (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;

        }

}

int hpsb_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;

        host->config_roms |= HPSB_CONFIG_ROM_ENTRY_IP1394;

        host->update_config_rom = 1;

        return 0;

}

EXPORT_SYMBOL_GPL(hpsb_config_rom_ip1394_add);

void hpsb_config_rom_ip1394_remove(struct hpsb_host *host)

{

        csr1212_detach_keyval_from_directory(host->csr.rom->root_kv, ip1394_ud);

        host->config_roms &= ~HPSB_CONFIG_ROM_ENTRY_IP1394;

        host->update_config_rom = 1;

}

EXPORT_SYMBOL_GPL(hpsb_config_rom_ip1394_remove);

static struct hpsb_config_rom_entry ip1394_entry = {

        .name           = "ip1394",

        .init           = config_rom_ip1394_init,

        .cleanup        = config_rom_ip1394_cleanup,

        .flag           = HPSB_CONFIG_ROM_ENTRY_IP1394,

};

#endif /* CONFIG_IEEE1394_ETH1394_ROM_ENTRY */

static struct hpsb_config_rom_entry *const config_rom_entries[] = {

#ifdef CONFIG_IEEE1394_ETH1394_ROM_ENTRY

        &ip1394_entry,

#endif

};

/* Initialize all config roms */

int hpsb_init_config_roms(void)

{

        int i, error = 0;

        for (i = 0; i < ARRAY_SIZE(config_rom_entries); i++)

                if (config_rom_entries[i]->init()) {

                        HPSB_ERR("Failed to initialize config rom entry `%s'",

                                 config_rom_entries[i]->name);

                        error = -1;

                }

        return error;

}

/* Cleanup all config roms */

void hpsb_cleanup_config_roms(void)

{

        int i;

        for (i = 0; i < ARRAY_SIZE(config_rom_entries); i++)

                config_rom_entries[i]->cleanup();

}