PageRenderTime 40ms CodeModel.GetById 12ms app.highlight 24ms RepoModel.GetById 1ms app.codeStats 1ms

/drivers/ieee1394/config_roms.c

https://bitbucket.org/evzijst/gittest
C | 236 lines | 172 code | 49 blank | 15 comment | 36 complexity | 838c5e52a6d6d1b15ab79606b9eedde9 MD5 | raw file
  1/*
  2 * IEEE 1394 for Linux
  3 *
  4 * ConfigROM  entries
  5 *
  6 * Copyright (C) 2004 Ben Collins
  7 *
  8 * This code is licensed under the GPL.  See the file COPYING in the root
  9 * directory of the kernel sources for details.
 10 */
 11
 12#include <linux/config.h>
 13#include <linux/types.h>
 14
 15#include "csr1212.h"
 16#include "ieee1394.h"
 17#include "ieee1394_types.h"
 18#include "hosts.h"
 19#include "ieee1394_core.h"
 20#include "highlevel.h"
 21#include "csr.h"
 22#include "config_roms.h"
 23
 24struct hpsb_config_rom_entry {
 25	const char *name;
 26
 27	/* Base initialization, called at module load */
 28	int (*init)(void);
 29
 30	/* Add entry to specified host */
 31	int (*add)(struct hpsb_host *host);
 32
 33	/* Remove entry from specified host */
 34	void (*remove)(struct hpsb_host *host);
 35
 36	/* Cleanup called at module exit */
 37	void (*cleanup)(void);
 38
 39	/* The flag added to host->config_roms */
 40	unsigned int flag;
 41};
 42
 43
 44int hpsb_default_host_entry(struct hpsb_host *host)
 45{
 46	struct csr1212_keyval *root;
 47	struct csr1212_keyval *vend_id = NULL;
 48	struct csr1212_keyval *text = NULL;
 49	char csr_name[128];
 50	int ret;
 51
 52	sprintf(csr_name, "Linux - %s", host->driver->name);
 53	root = host->csr.rom->root_kv;
 54
 55	vend_id = csr1212_new_immediate(CSR1212_KV_ID_VENDOR, host->csr.guid_hi >> 8);
 56	text = csr1212_new_string_descriptor_leaf(csr_name);
 57
 58	if (!vend_id || !text) {
 59		if (vend_id)
 60			csr1212_release_keyval(vend_id);
 61		if (text)
 62			csr1212_release_keyval(text);
 63		csr1212_destroy_csr(host->csr.rom);
 64		return -ENOMEM;
 65	}
 66
 67	ret = csr1212_associate_keyval(vend_id, text);
 68	csr1212_release_keyval(text);
 69	ret |= csr1212_attach_keyval_to_directory(root, vend_id);
 70	csr1212_release_keyval(vend_id);
 71	if (ret != CSR1212_SUCCESS) {
 72		csr1212_destroy_csr(host->csr.rom);
 73		return -ENOMEM;
 74	}
 75
 76	host->update_config_rom = 1;
 77
 78	return 0;
 79}
 80
 81
 82#ifdef CONFIG_IEEE1394_CONFIG_ROM_IP1394
 83#include "eth1394.h"
 84
 85static struct csr1212_keyval *ip1394_ud;
 86
 87static int config_rom_ip1394_init(void)
 88{
 89	struct csr1212_keyval *spec_id = NULL;
 90	struct csr1212_keyval *spec_desc = NULL;
 91	struct csr1212_keyval *ver = NULL;
 92	struct csr1212_keyval *ver_desc = NULL;
 93	int ret = -ENOMEM;
 94
 95	ip1394_ud = csr1212_new_directory(CSR1212_KV_ID_UNIT);
 96
 97	spec_id = csr1212_new_immediate(CSR1212_KV_ID_SPECIFIER_ID,
 98					ETHER1394_GASP_SPECIFIER_ID);
 99	spec_desc = csr1212_new_string_descriptor_leaf("IANA");
100	ver = csr1212_new_immediate(CSR1212_KV_ID_VERSION,
101				    ETHER1394_GASP_VERSION);
102	ver_desc = csr1212_new_string_descriptor_leaf("IPv4");
103
104	if (!ip1394_ud || !spec_id || !spec_desc || !ver || !ver_desc)
105		goto ip1394_fail;
106
107	if (csr1212_associate_keyval(spec_id, spec_desc) == CSR1212_SUCCESS &&
108	    csr1212_associate_keyval(ver, ver_desc) == CSR1212_SUCCESS &&
109	    csr1212_attach_keyval_to_directory(ip1394_ud, spec_id) == CSR1212_SUCCESS &&
110	    csr1212_attach_keyval_to_directory(ip1394_ud, ver) == CSR1212_SUCCESS)
111		ret = 0;
112
113ip1394_fail:
114	if (ret && ip1394_ud) {
115		csr1212_release_keyval(ip1394_ud);
116		ip1394_ud = NULL;
117	}
118
119	if (spec_id)
120		csr1212_release_keyval(spec_id);
121	if (spec_desc)
122		csr1212_release_keyval(spec_desc);
123	if (ver)
124		csr1212_release_keyval(ver);
125	if (ver_desc)
126		csr1212_release_keyval(ver_desc);
127
128	return ret;
129}
130
131static void config_rom_ip1394_cleanup(void)
132{
133	if (ip1394_ud) {
134		csr1212_release_keyval(ip1394_ud);
135		ip1394_ud = NULL;
136	}
137}
138
139static int config_rom_ip1394_add(struct hpsb_host *host)
140{
141	if (!ip1394_ud)
142		return -ENODEV;
143
144	if (csr1212_attach_keyval_to_directory(host->csr.rom->root_kv,
145					       ip1394_ud) != CSR1212_SUCCESS)
146		return -ENOMEM;
147
148	return 0;
149}
150
151static void config_rom_ip1394_remove(struct hpsb_host *host)
152{
153	csr1212_detach_keyval_from_directory(host->csr.rom->root_kv, ip1394_ud);
154}
155
156static struct hpsb_config_rom_entry ip1394_entry = {
157	.name		= "ip1394",
158	.init		= config_rom_ip1394_init,
159	.add		= config_rom_ip1394_add,
160	.remove		= config_rom_ip1394_remove,
161	.cleanup	= config_rom_ip1394_cleanup,
162	.flag		= HPSB_CONFIG_ROM_ENTRY_IP1394,
163};
164#endif /* CONFIG_IEEE1394_CONFIG_ROM_IP1394 */
165
166
167static struct hpsb_config_rom_entry *const config_rom_entries[] = {
168#ifdef CONFIG_IEEE1394_CONFIG_ROM_IP1394
169	&ip1394_entry,
170#endif
171	NULL,
172};
173
174
175int hpsb_init_config_roms(void)
176{
177	int i, error = 0;
178
179	for (i = 0; config_rom_entries[i]; i++) {
180		if (!config_rom_entries[i]->init)
181			continue;
182
183		if (config_rom_entries[i]->init()) {
184			HPSB_ERR("Failed to initialize config rom entry `%s'",
185				 config_rom_entries[i]->name);
186			error = -1;
187		} else
188			HPSB_DEBUG("Initialized config rom entry `%s'",
189				   config_rom_entries[i]->name);
190	}
191
192	return error;
193}
194
195void hpsb_cleanup_config_roms(void)
196{
197	int i;
198
199	for (i = 0; config_rom_entries[i]; i++) {
200		if (config_rom_entries[i]->cleanup)
201			config_rom_entries[i]->cleanup();
202	}
203}
204
205int hpsb_add_extra_config_roms(struct hpsb_host *host)
206{
207	int i, error = 0;
208
209	for (i = 0; config_rom_entries[i]; i++) {
210		if (config_rom_entries[i]->add(host)) {
211			HPSB_ERR("fw-host%d: Failed to attach config rom entry `%s'",
212				 host->id, config_rom_entries[i]->name);
213			error = -1;
214		} else {
215			host->config_roms |= config_rom_entries[i]->flag;
216			host->update_config_rom = 1;
217		}
218	}
219
220	return error;
221}
222
223void hpsb_remove_extra_config_roms(struct hpsb_host *host)
224{
225	int i;
226
227	for (i = 0; config_rom_entries[i]; i++) {
228		if (!(host->config_roms & config_rom_entries[i]->flag))
229			continue;
230
231		config_rom_entries[i]->remove(host);
232
233		host->config_roms &= ~config_rom_entries[i]->flag;
234		host->update_config_rom = 1;
235	}
236}