mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-08-21 16:29:59 +00:00
![Jörn Engel](/assets/img/avatar_default.png)
Signed-off-by: Jörn Engel <joern@wohnheim.fh-wedel.de> Signed-off-by: Adrian Bunk <bunk@stusta.de>
235 lines
5.3 KiB
C
235 lines
5.3 KiB
C
/*
|
|
* 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;
|
|
}
|
|
}
|