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 | ||
1da177e4 LT |
12 | #include <linux/types.h> |
13 | ||
14 | #include "csr1212.h" | |
15 | #include "ieee1394.h" | |
16 | #include "ieee1394_types.h" | |
17 | #include "hosts.h" | |
18 | #include "ieee1394_core.h" | |
19 | #include "highlevel.h" | |
20 | #include "csr.h" | |
21 | #include "config_roms.h" | |
22 | ||
23 | struct hpsb_config_rom_entry { | |
24 | const char *name; | |
25 | ||
26 | /* Base initialization, called at module load */ | |
27 | int (*init)(void); | |
28 | ||
1da177e4 LT |
29 | /* Cleanup called at module exit */ |
30 | void (*cleanup)(void); | |
31 | ||
32 | /* The flag added to host->config_roms */ | |
33 | unsigned int flag; | |
34 | }; | |
35 | ||
afd6546d | 36 | /* The default host entry. This must succeed. */ |
1da177e4 LT |
37 | int hpsb_default_host_entry(struct hpsb_host *host) |
38 | { | |
39 | struct csr1212_keyval *root; | |
40 | struct csr1212_keyval *vend_id = NULL; | |
41 | struct csr1212_keyval *text = NULL; | |
42 | char csr_name[128]; | |
43 | int ret; | |
44 | ||
45 | sprintf(csr_name, "Linux - %s", host->driver->name); | |
46 | root = host->csr.rom->root_kv; | |
47 | ||
48 | vend_id = csr1212_new_immediate(CSR1212_KV_ID_VENDOR, host->csr.guid_hi >> 8); | |
49 | text = csr1212_new_string_descriptor_leaf(csr_name); | |
50 | ||
51 | if (!vend_id || !text) { | |
52 | if (vend_id) | |
53 | csr1212_release_keyval(vend_id); | |
54 | if (text) | |
55 | csr1212_release_keyval(text); | |
56 | csr1212_destroy_csr(host->csr.rom); | |
57 | return -ENOMEM; | |
58 | } | |
59 | ||
64ff7123 | 60 | csr1212_associate_keyval(vend_id, text); |
1da177e4 | 61 | csr1212_release_keyval(text); |
64ff7123 | 62 | ret = csr1212_attach_keyval_to_directory(root, vend_id); |
1da177e4 LT |
63 | csr1212_release_keyval(vend_id); |
64 | if (ret != CSR1212_SUCCESS) { | |
65 | csr1212_destroy_csr(host->csr.rom); | |
66 | return -ENOMEM; | |
67 | } | |
68 | ||
69 | host->update_config_rom = 1; | |
70 | ||
71 | return 0; | |
72 | } | |
73 | ||
74 | ||
70093cfd | 75 | #ifdef CONFIG_IEEE1394_ETH1394_ROM_ENTRY |
1da177e4 LT |
76 | #include "eth1394.h" |
77 | ||
78 | static struct csr1212_keyval *ip1394_ud; | |
79 | ||
80 | static int config_rom_ip1394_init(void) | |
81 | { | |
82 | struct csr1212_keyval *spec_id = NULL; | |
83 | struct csr1212_keyval *spec_desc = NULL; | |
84 | struct csr1212_keyval *ver = NULL; | |
85 | struct csr1212_keyval *ver_desc = NULL; | |
86 | int ret = -ENOMEM; | |
87 | ||
88 | ip1394_ud = csr1212_new_directory(CSR1212_KV_ID_UNIT); | |
89 | ||
90 | spec_id = csr1212_new_immediate(CSR1212_KV_ID_SPECIFIER_ID, | |
91 | ETHER1394_GASP_SPECIFIER_ID); | |
92 | spec_desc = csr1212_new_string_descriptor_leaf("IANA"); | |
93 | ver = csr1212_new_immediate(CSR1212_KV_ID_VERSION, | |
94 | ETHER1394_GASP_VERSION); | |
95 | ver_desc = csr1212_new_string_descriptor_leaf("IPv4"); | |
96 | ||
97 | if (!ip1394_ud || !spec_id || !spec_desc || !ver || !ver_desc) | |
98 | goto ip1394_fail; | |
99 | ||
64ff7123 SR |
100 | csr1212_associate_keyval(spec_id, spec_desc); |
101 | csr1212_associate_keyval(ver, ver_desc); | |
102 | if (csr1212_attach_keyval_to_directory(ip1394_ud, spec_id) | |
103 | == CSR1212_SUCCESS && | |
104 | csr1212_attach_keyval_to_directory(ip1394_ud, ver) | |
105 | == CSR1212_SUCCESS) | |
1da177e4 LT |
106 | ret = 0; |
107 | ||
108 | ip1394_fail: | |
109 | if (ret && ip1394_ud) { | |
110 | csr1212_release_keyval(ip1394_ud); | |
111 | ip1394_ud = NULL; | |
112 | } | |
113 | ||
114 | if (spec_id) | |
115 | csr1212_release_keyval(spec_id); | |
116 | if (spec_desc) | |
117 | csr1212_release_keyval(spec_desc); | |
118 | if (ver) | |
119 | csr1212_release_keyval(ver); | |
120 | if (ver_desc) | |
121 | csr1212_release_keyval(ver_desc); | |
122 | ||
123 | return ret; | |
124 | } | |
125 | ||
126 | static void config_rom_ip1394_cleanup(void) | |
127 | { | |
128 | if (ip1394_ud) { | |
129 | csr1212_release_keyval(ip1394_ud); | |
130 | ip1394_ud = NULL; | |
131 | } | |
132 | } | |
133 | ||
70093cfd | 134 | int hpsb_config_rom_ip1394_add(struct hpsb_host *host) |
1da177e4 LT |
135 | { |
136 | if (!ip1394_ud) | |
137 | return -ENODEV; | |
138 | ||
139 | if (csr1212_attach_keyval_to_directory(host->csr.rom->root_kv, | |
140 | ip1394_ud) != CSR1212_SUCCESS) | |
141 | return -ENOMEM; | |
142 | ||
70093cfd SR |
143 | host->config_roms |= HPSB_CONFIG_ROM_ENTRY_IP1394; |
144 | host->update_config_rom = 1; | |
1da177e4 LT |
145 | return 0; |
146 | } | |
70093cfd | 147 | EXPORT_SYMBOL_GPL(hpsb_config_rom_ip1394_add); |
1da177e4 | 148 | |
70093cfd | 149 | void hpsb_config_rom_ip1394_remove(struct hpsb_host *host) |
1da177e4 LT |
150 | { |
151 | csr1212_detach_keyval_from_directory(host->csr.rom->root_kv, ip1394_ud); | |
70093cfd SR |
152 | host->config_roms &= ~HPSB_CONFIG_ROM_ENTRY_IP1394; |
153 | host->update_config_rom = 1; | |
1da177e4 | 154 | } |
70093cfd | 155 | EXPORT_SYMBOL_GPL(hpsb_config_rom_ip1394_remove); |
1da177e4 LT |
156 | |
157 | static struct hpsb_config_rom_entry ip1394_entry = { | |
158 | .name = "ip1394", | |
159 | .init = config_rom_ip1394_init, | |
1da177e4 LT |
160 | .cleanup = config_rom_ip1394_cleanup, |
161 | .flag = HPSB_CONFIG_ROM_ENTRY_IP1394, | |
162 | }; | |
1da177e4 | 163 | |
70093cfd | 164 | #endif /* CONFIG_IEEE1394_ETH1394_ROM_ENTRY */ |
1da177e4 LT |
165 | |
166 | static struct hpsb_config_rom_entry *const config_rom_entries[] = { | |
70093cfd | 167 | #ifdef CONFIG_IEEE1394_ETH1394_ROM_ENTRY |
1da177e4 LT |
168 | &ip1394_entry, |
169 | #endif | |
1da177e4 LT |
170 | }; |
171 | ||
afd6546d | 172 | /* Initialize all config roms */ |
1da177e4 LT |
173 | int hpsb_init_config_roms(void) |
174 | { | |
175 | int i, error = 0; | |
176 | ||
70093cfd | 177 | for (i = 0; i < ARRAY_SIZE(config_rom_entries); i++) |
1da177e4 LT |
178 | if (config_rom_entries[i]->init()) { |
179 | HPSB_ERR("Failed to initialize config rom entry `%s'", | |
180 | config_rom_entries[i]->name); | |
181 | error = -1; | |
70093cfd | 182 | } |
1da177e4 LT |
183 | |
184 | return error; | |
185 | } | |
186 | ||
afd6546d | 187 | /* Cleanup all config roms */ |
1da177e4 LT |
188 | void hpsb_cleanup_config_roms(void) |
189 | { | |
190 | int i; | |
191 | ||
70093cfd SR |
192 | for (i = 0; i < ARRAY_SIZE(config_rom_entries); i++) |
193 | config_rom_entries[i]->cleanup(); | |
1da177e4 | 194 | } |