Merge branch 'upstream-jgarzik' of git://git.tuxdriver.com/git/wireless-2.6
[linux-2.6] / drivers / ieee1394 / config_roms.c
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 }