Commit | Line | Data |
---|---|---|
1da177e4 LT |
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 | ||
24 | struct 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 | ||
44 | int 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 | ||
85 | static struct csr1212_keyval *ip1394_ud; | |
86 | ||
87 | static 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 | ||
113 | ip1394_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 | ||
131 | static void config_rom_ip1394_cleanup(void) | |
132 | { | |
133 | if (ip1394_ud) { | |
134 | csr1212_release_keyval(ip1394_ud); | |
135 | ip1394_ud = NULL; | |
136 | } | |
137 | } | |
138 | ||
139 | static 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 | ||
151 | static 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 | ||
156 | static 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 | ||
167 | static 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 | ||
175 | int 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 | ||
195 | void 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 | ||
205 | int 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 | ||
223 | void 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 | } |