Blame view
drivers/ieee1394/nodemgr.c
51.5 KB
1da177e4c Linux-2.6.12-rc2 |
1 2 3 4 5 6 7 8 9 |
/* * Node information (ConfigROM) collection and management. * * Copyright (C) 2000 Andreas E. Bombe * 2001-2003 Ben Collins <bcollins@debian.net> * * This code is licensed under the GPL. See the file COPYING in the root * directory of the kernel sources for details. */ |
09a9a45dc [PATCH] ieee1394:... |
10 |
#include <linux/bitmap.h> |
1da177e4c Linux-2.6.12-rc2 |
11 |
#include <linux/kernel.h> |
004cdb5a7 ieee1394: annotat... |
12 |
#include <linux/kmemcheck.h> |
1da177e4c Linux-2.6.12-rc2 |
13 14 |
#include <linux/list.h> #include <linux/slab.h> |
1da177e4c Linux-2.6.12-rc2 |
15 |
#include <linux/delay.h> |
d2f119fe3 [PATCH] ieee1394:... |
16 |
#include <linux/kthread.h> |
8252bbb13 ieee1394: nodemgr... |
17 |
#include <linux/module.h> |
1da177e4c Linux-2.6.12-rc2 |
18 |
#include <linux/moduleparam.h> |
9543a931d ieee1394: some mo... |
19 |
#include <linux/mutex.h> |
7dfb71030 [PATCH] Add inclu... |
20 |
#include <linux/freezer.h> |
1da177e4c Linux-2.6.12-rc2 |
21 |
#include <asm/atomic.h> |
de4394f13 [PATCH] ieee1394:... |
22 23 24 |
#include "csr.h" #include "highlevel.h" #include "hosts.h" |
1da177e4c Linux-2.6.12-rc2 |
25 26 |
#include "ieee1394.h" #include "ieee1394_core.h" |
de4394f13 [PATCH] ieee1394:... |
27 28 |
#include "ieee1394_hotplug.h" #include "ieee1394_types.h" |
1da177e4c Linux-2.6.12-rc2 |
29 |
#include "ieee1394_transactions.h" |
1da177e4c Linux-2.6.12-rc2 |
30 |
#include "nodemgr.h" |
1934b8b65 [PATCH] Sync up i... |
31 |
static int ignore_drivers; |
3a632fe23 [PATCH] ieee1394:... |
32 |
module_param(ignore_drivers, int, S_IRUGO | S_IWUSR); |
1da177e4c Linux-2.6.12-rc2 |
33 34 35 36 37 38 |
MODULE_PARM_DESC(ignore_drivers, "Disable automatic probing for drivers."); struct nodemgr_csr_info { struct hpsb_host *host; nodeid_t nodeid; unsigned int generation; |
004cdb5a7 ieee1394: annotat... |
39 40 |
kmemcheck_bitfield_begin(flags); |
647dcb5fa ieee1394: support... |
41 |
unsigned int speed_unverified:1; |
004cdb5a7 ieee1394: annotat... |
42 |
kmemcheck_bitfield_end(flags); |
1da177e4c Linux-2.6.12-rc2 |
43 |
}; |
647dcb5fa ieee1394: support... |
44 45 46 47 48 49 50 51 52 53 54 |
/* * Correct the speed map entry. This is necessary * - for nodes with link speed < phy speed, * - for 1394b nodes with negotiated phy port speed < IEEE1394_SPEED_MAX. * A possible speed is determined by trial and error, using quadlet reads. */ static int nodemgr_check_speed(struct nodemgr_csr_info *ci, u64 addr, quadlet_t *buffer) { quadlet_t q; u8 i, *speed, old_speed, good_speed; |
7fdfc9094 ieee1394: nodemgr... |
55 |
int error; |
647dcb5fa ieee1394: support... |
56 |
|
d7530a1e7 [PATCH] ieee1394:... |
57 |
speed = &(ci->host->speed[NODEID_TO_NODE(ci->nodeid)]); |
647dcb5fa ieee1394: support... |
58 59 60 61 62 63 64 65 66 |
old_speed = *speed; good_speed = IEEE1394_SPEED_MAX + 1; /* Try every speed from S100 to old_speed. * If we did it the other way around, a too low speed could be caught * if the retry succeeded for some other reason, e.g. because the link * just finished its initialization. */ for (i = IEEE1394_SPEED_100; i <= old_speed; i++) { *speed = i; |
7fdfc9094 ieee1394: nodemgr... |
67 |
error = hpsb_read(ci->host, ci->nodeid, ci->generation, addr, |
0bed18196 ieee1394: ignore ... |
68 |
&q, 4); |
7fdfc9094 ieee1394: nodemgr... |
69 |
if (error) |
647dcb5fa ieee1394: support... |
70 71 72 73 74 75 76 77 78 79 80 81 82 |
break; *buffer = q; good_speed = i; } if (good_speed <= IEEE1394_SPEED_MAX) { HPSB_DEBUG("Speed probe of node " NODE_BUS_FMT " yields %s", NODE_BUS_ARGS(ci->host, ci->nodeid), hpsb_speedto_str[good_speed]); *speed = good_speed; ci->speed_unverified = 0; return 0; } *speed = old_speed; |
7fdfc9094 ieee1394: nodemgr... |
83 |
return error; |
647dcb5fa ieee1394: support... |
84 |
} |
1da177e4c Linux-2.6.12-rc2 |
85 |
|
0bed18196 ieee1394: ignore ... |
86 |
static int nodemgr_bus_read(struct csr1212_csr *csr, u64 addr, |
d41bba2d3 ieee1394: nodemgr... |
87 |
void *buffer, void *__ci) |
1da177e4c Linux-2.6.12-rc2 |
88 89 |
{ struct nodemgr_csr_info *ci = (struct nodemgr_csr_info*)__ci; |
7fdfc9094 ieee1394: nodemgr... |
90 |
int i, error; |
1da177e4c Linux-2.6.12-rc2 |
91 |
|
e31a127c2 [PATCH] ieee1394:... |
92 |
for (i = 1; ; i++) { |
7fdfc9094 ieee1394: nodemgr... |
93 |
error = hpsb_read(ci->host, ci->nodeid, ci->generation, addr, |
0bed18196 ieee1394: ignore ... |
94 |
buffer, 4); |
7fdfc9094 ieee1394: nodemgr... |
95 |
if (!error) { |
647dcb5fa ieee1394: support... |
96 97 98 99 100 |
ci->speed_unverified = 0; break; } /* Give up after 3rd failure. */ if (i == 3) |
1da177e4c Linux-2.6.12-rc2 |
101 |
break; |
647dcb5fa ieee1394: support... |
102 103 |
/* The ieee1394_core guessed the node's speed capability from * the self ID. Check whether a lower speed works. */ |
0bed18196 ieee1394: ignore ... |
104 |
if (ci->speed_unverified) { |
7fdfc9094 ieee1394: nodemgr... |
105 106 |
error = nodemgr_check_speed(ci, addr, buffer); if (!error) |
647dcb5fa ieee1394: support... |
107 108 |
break; } |
1da177e4c Linux-2.6.12-rc2 |
109 110 111 |
if (msleep_interruptible(334)) return -EINTR; } |
7fdfc9094 ieee1394: nodemgr... |
112 |
return error; |
1da177e4c Linux-2.6.12-rc2 |
113 |
} |
1da177e4c Linux-2.6.12-rc2 |
114 115 |
static struct csr1212_bus_ops nodemgr_csr_ops = { .bus_read = nodemgr_bus_read, |
1da177e4c Linux-2.6.12-rc2 |
116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 |
}; /* * Basically what we do here is start off retrieving the bus_info block. * From there will fill in some info about the node, verify it is of IEEE * 1394 type, and that the crc checks out ok. After that we start off with * the root directory, and subdirectories. To do this, we retrieve the * quadlet header for a directory, find out the length, and retrieve the * complete directory entry (be it a leaf or a directory). We then process * it and add the info to our structure for that particular node. * * We verify CRC's along the way for each directory/block/leaf. The entire * node structure is generic, and simply stores the information in a way * that's easy to parse by the protocol interface. */ /* * The nodemgr relies heavily on the Driver Model for device callbacks and * driver/device mappings. The old nodemgr used to handle all this itself, * but now we are much simpler because of the LDM. */ |
1da177e4c Linux-2.6.12-rc2 |
138 139 140 |
struct host_info { struct hpsb_host *host; struct list_head list; |
d2f119fe3 [PATCH] ieee1394:... |
141 |
struct task_struct *thread; |
1da177e4c Linux-2.6.12-rc2 |
142 143 144 |
}; static int nodemgr_bus_match(struct device * dev, struct device_driver * drv); |
7eff2e7a8 Driver core: chan... |
145 |
static int nodemgr_uevent(struct device *dev, struct kobj_uevent_env *env); |
1da177e4c Linux-2.6.12-rc2 |
146 147 148 149 150 |
struct bus_type ieee1394_bus_type = { .name = "ieee1394", .match = nodemgr_bus_match, }; |
dd7f2928d ieee1394: convert... |
151 |
static void host_cls_release(struct device *dev) |
1da177e4c Linux-2.6.12-rc2 |
152 |
{ |
dd7f2928d ieee1394: convert... |
153 |
put_device(&container_of((dev), struct hpsb_host, host_dev)->device); |
1da177e4c Linux-2.6.12-rc2 |
154 155 156 157 |
} struct class hpsb_host_class = { .name = "ieee1394_host", |
dd7f2928d ieee1394: convert... |
158 |
.dev_release = host_cls_release, |
1da177e4c Linux-2.6.12-rc2 |
159 |
}; |
dd7f2928d ieee1394: convert... |
160 |
static void ne_cls_release(struct device *dev) |
1da177e4c Linux-2.6.12-rc2 |
161 |
{ |
dd7f2928d ieee1394: convert... |
162 |
put_device(&container_of((dev), struct node_entry, node_dev)->device); |
1da177e4c Linux-2.6.12-rc2 |
163 164 165 166 |
} static struct class nodemgr_ne_class = { .name = "ieee1394_node", |
dd7f2928d ieee1394: convert... |
167 |
.dev_release = ne_cls_release, |
1da177e4c Linux-2.6.12-rc2 |
168 |
}; |
dd7f2928d ieee1394: convert... |
169 |
static void ud_cls_release(struct device *dev) |
1da177e4c Linux-2.6.12-rc2 |
170 |
{ |
dd7f2928d ieee1394: convert... |
171 |
put_device(&container_of((dev), struct unit_directory, unit_dev)->device); |
1da177e4c Linux-2.6.12-rc2 |
172 173 174 |
} /* The name here is only so that unit directory hotplug works with old |
dd7f2928d ieee1394: convert... |
175 176 |
* style hotplug, which only ever did unit directories anyway. */ |
1da177e4c Linux-2.6.12-rc2 |
177 178 |
static struct class nodemgr_ud_class = { .name = "ieee1394", |
dd7f2928d ieee1394: convert... |
179 180 |
.dev_release = ud_cls_release, .dev_uevent = nodemgr_uevent, |
1da177e4c Linux-2.6.12-rc2 |
181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 |
}; static struct hpsb_highlevel nodemgr_highlevel; static void nodemgr_release_ud(struct device *dev) { struct unit_directory *ud = container_of(dev, struct unit_directory, device); if (ud->vendor_name_kv) csr1212_release_keyval(ud->vendor_name_kv); if (ud->model_name_kv) csr1212_release_keyval(ud->model_name_kv); kfree(ud); } static void nodemgr_release_ne(struct device *dev) { struct node_entry *ne = container_of(dev, struct node_entry, device); if (ne->vendor_name_kv) csr1212_release_keyval(ne->vendor_name_kv); kfree(ne); } static void nodemgr_release_host(struct device *dev) { struct hpsb_host *host = container_of(dev, struct hpsb_host, device); csr1212_destroy_csr(host->csr.rom); kfree(host); } static int nodemgr_ud_platform_data; static struct device nodemgr_dev_template_ud = { .bus = &ieee1394_bus_type, .release = nodemgr_release_ud, .platform_data = &nodemgr_ud_platform_data, }; static struct device nodemgr_dev_template_ne = { .bus = &ieee1394_bus_type, .release = nodemgr_release_ne, }; |
8252bbb13 ieee1394: nodemgr... |
230 231 232 233 234 235 236 237 238 |
/* This dummy driver prevents the host devices from being scanned. We have no * useful drivers for them yet, and there would be a deadlock possible if the * driver core scans the host device while the host's low-level driver (i.e. * the host's parent device) is being removed. */ static struct device_driver nodemgr_mid_layer_driver = { .bus = &ieee1394_bus_type, .name = "nodemgr", .owner = THIS_MODULE, }; |
1da177e4c Linux-2.6.12-rc2 |
239 240 241 242 243 244 245 |
struct device nodemgr_dev_template_host = { .bus = &ieee1394_bus_type, .release = nodemgr_release_host, }; #define fw_attr(class, class_type, field, type, format_string) \ |
e404e274f [PATCH] Driver Co... |
246 |
static ssize_t fw_show_##class##_##field (struct device *dev, struct device_attribute *attr, char *buf)\ |
1da177e4c Linux-2.6.12-rc2 |
247 248 249 250 251 252 253 254 255 256 257 |
{ \ class_type *class; \ class = container_of(dev, class_type, device); \ return sprintf(buf, format_string, (type)class->field); \ } \ static struct device_attribute dev_attr_##class##_##field = { \ .attr = {.name = __stringify(field), .mode = S_IRUGO }, \ .show = fw_show_##class##_##field, \ }; #define fw_attr_td(class, class_type, td_kv) \ |
e404e274f [PATCH] Driver Co... |
258 |
static ssize_t fw_show_##class##_##td_kv (struct device *dev, struct device_attribute *attr, char *buf)\ |
1da177e4c Linux-2.6.12-rc2 |
259 260 261 262 263 264 265 |
{ \ int len; \ class_type *class = container_of(dev, class_type, device); \ len = (class->td_kv->value.leaf.len - 2) * sizeof(quadlet_t); \ memcpy(buf, \ CSR1212_TEXTUAL_DESCRIPTOR_LEAF_DATA(class->td_kv), \ len); \ |
51ec138c6 ieee1394: forgott... |
266 |
while (buf[len - 1] == '\0') \ |
1da177e4c Linux-2.6.12-rc2 |
267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 |
len--; \ buf[len++] = ' '; \ buf[len] = '\0'; \ return len; \ } \ static struct device_attribute dev_attr_##class##_##td_kv = { \ .attr = {.name = __stringify(td_kv), .mode = S_IRUGO }, \ .show = fw_show_##class##_##td_kv, \ }; #define fw_drv_attr(field, type, format_string) \ static ssize_t fw_drv_show_##field (struct device_driver *drv, char *buf) \ { \ struct hpsb_protocol_driver *driver; \ driver = container_of(drv, struct hpsb_protocol_driver, driver); \ return sprintf(buf, format_string, (type)driver->field);\ } \ static struct driver_attribute driver_attr_drv_##field = { \ |
d41bba2d3 ieee1394: nodemgr... |
287 288 |
.attr = {.name = __stringify(field), .mode = S_IRUGO }, \ .show = fw_drv_show_##field, \ |
1da177e4c Linux-2.6.12-rc2 |
289 |
}; |
e404e274f [PATCH] Driver Co... |
290 |
static ssize_t fw_show_ne_bus_options(struct device *dev, struct device_attribute *attr, char *buf) |
1da177e4c Linux-2.6.12-rc2 |
291 292 293 294 295 296 297 298 299 300 301 302 303 304 |
{ struct node_entry *ne = container_of(dev, struct node_entry, device); return sprintf(buf, "IRMC(%d) CMC(%d) ISC(%d) BMC(%d) PMC(%d) GEN(%d) " "LSPD(%d) MAX_REC(%d) MAX_ROM(%d) CYC_CLK_ACC(%d) ", ne->busopt.irmc, ne->busopt.cmc, ne->busopt.isc, ne->busopt.bmc, ne->busopt.pmc, ne->busopt.generation, ne->busopt.lnkspd, ne->busopt.max_rec, ne->busopt.max_rom, ne->busopt.cyc_clk_acc); } static DEVICE_ATTR(bus_options,S_IRUGO,fw_show_ne_bus_options,NULL); |
9951903e6 ieee1394: shrink ... |
305 306 307 |
#ifdef HPSB_DEBUG_TLABELS static ssize_t fw_show_ne_tlabels_free(struct device *dev, struct device_attribute *attr, char *buf) |
1da177e4c Linux-2.6.12-rc2 |
308 309 |
{ struct node_entry *ne = container_of(dev, struct node_entry, device); |
9951903e6 ieee1394: shrink ... |
310 311 312 |
unsigned long flags; unsigned long *tp = ne->host->tl_pool[NODEID_TO_NODE(ne->nodeid)].map; int tf; |
1da177e4c Linux-2.6.12-rc2 |
313 |
|
9951903e6 ieee1394: shrink ... |
314 315 316 |
spin_lock_irqsave(&hpsb_tlabel_lock, flags); tf = 64 - bitmap_weight(tp, 64); spin_unlock_irqrestore(&hpsb_tlabel_lock, flags); |
1da177e4c Linux-2.6.12-rc2 |
317 |
|
9951903e6 ieee1394: shrink ... |
318 319 |
return sprintf(buf, "%d ", tf); |
1da177e4c Linux-2.6.12-rc2 |
320 |
} |
9951903e6 ieee1394: shrink ... |
321 |
static DEVICE_ATTR(tlabels_free,S_IRUGO,fw_show_ne_tlabels_free,NULL); |
1da177e4c Linux-2.6.12-rc2 |
322 |
|
9951903e6 ieee1394: shrink ... |
323 324 |
static ssize_t fw_show_ne_tlabels_mask(struct device *dev, struct device_attribute *attr, char *buf) |
1da177e4c Linux-2.6.12-rc2 |
325 326 |
{ struct node_entry *ne = container_of(dev, struct node_entry, device); |
9951903e6 ieee1394: shrink ... |
327 328 329 330 331 |
unsigned long flags; unsigned long *tp = ne->host->tl_pool[NODEID_TO_NODE(ne->nodeid)].map; u64 tm; spin_lock_irqsave(&hpsb_tlabel_lock, flags); |
1da177e4c Linux-2.6.12-rc2 |
332 |
#if (BITS_PER_LONG <= 32) |
9951903e6 ieee1394: shrink ... |
333 |
tm = ((u64)tp[0] << 32) + tp[1]; |
1da177e4c Linux-2.6.12-rc2 |
334 |
#else |
9951903e6 ieee1394: shrink ... |
335 |
tm = tp[0]; |
1da177e4c Linux-2.6.12-rc2 |
336 |
#endif |
9951903e6 ieee1394: shrink ... |
337 |
spin_unlock_irqrestore(&hpsb_tlabel_lock, flags); |
7f5880394 ieee1394: fix pri... |
338 339 |
return sprintf(buf, "0x%016llx ", (unsigned long long)tm); |
1da177e4c Linux-2.6.12-rc2 |
340 341 |
} static DEVICE_ATTR(tlabels_mask, S_IRUGO, fw_show_ne_tlabels_mask, NULL); |
9951903e6 ieee1394: shrink ... |
342 |
#endif /* HPSB_DEBUG_TLABELS */ |
1da177e4c Linux-2.6.12-rc2 |
343 |
|
e404e274f [PATCH] Driver Co... |
344 |
static ssize_t fw_set_ignore_driver(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) |
1da177e4c Linux-2.6.12-rc2 |
345 346 347 348 349 |
{ struct unit_directory *ud = container_of(dev, struct unit_directory, device); int state = simple_strtoul(buf, NULL, 10); if (state == 1) { |
1da177e4c Linux-2.6.12-rc2 |
350 |
ud->ignore_driver = 1; |
b07375b15 ieee1394: nodemgr... |
351 |
device_release_driver(dev); |
b07375b15 ieee1394: nodemgr... |
352 |
} else if (state == 0) |
1da177e4c Linux-2.6.12-rc2 |
353 354 355 356 |
ud->ignore_driver = 0; return count; } |
e404e274f [PATCH] Driver Co... |
357 |
static ssize_t fw_get_ignore_driver(struct device *dev, struct device_attribute *attr, char *buf) |
1da177e4c Linux-2.6.12-rc2 |
358 359 360 361 362 363 364 |
{ struct unit_directory *ud = container_of(dev, struct unit_directory, device); return sprintf(buf, "%d ", ud->ignore_driver); } static DEVICE_ATTR(ignore_driver, S_IWUSR | S_IRUGO, fw_get_ignore_driver, fw_set_ignore_driver); |
c1c9c7cd9 ieee1394: handle ... |
365 366 |
static ssize_t fw_set_rescan(struct bus_type *bus, const char *buf, size_t count) |
1da177e4c Linux-2.6.12-rc2 |
367 |
{ |
c1c9c7cd9 ieee1394: handle ... |
368 |
int error = 0; |
40fd89cc5 [PATCH] ieee1394:... |
369 |
if (simple_strtoul(buf, NULL, 10) == 1) |
c1c9c7cd9 ieee1394: handle ... |
370 371 |
error = bus_rescan_devices(&ieee1394_bus_type); return error ? error : count; |
1da177e4c Linux-2.6.12-rc2 |
372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 |
} static ssize_t fw_get_rescan(struct bus_type *bus, char *buf) { return sprintf(buf, "You can force a rescan of the bus for " "drivers by writing a 1 to this file "); } static BUS_ATTR(rescan, S_IWUSR | S_IRUGO, fw_get_rescan, fw_set_rescan); static ssize_t fw_set_ignore_drivers(struct bus_type *bus, const char *buf, size_t count) { int state = simple_strtoul(buf, NULL, 10); if (state == 1) ignore_drivers = 1; |
b07375b15 ieee1394: nodemgr... |
388 |
else if (state == 0) |
1da177e4c Linux-2.6.12-rc2 |
389 390 391 392 393 394 395 396 397 398 399 400 401 |
ignore_drivers = 0; return count; } static ssize_t fw_get_ignore_drivers(struct bus_type *bus, char *buf) { return sprintf(buf, "%d ", ignore_drivers); } static BUS_ATTR(ignore_drivers, S_IWUSR | S_IRUGO, fw_get_ignore_drivers, fw_set_ignore_drivers); struct bus_attribute *const fw_bus_attrs[] = { |
1da177e4c Linux-2.6.12-rc2 |
402 403 404 405 406 407 408 409 410 411 412 413 414 415 |
&bus_attr_rescan, &bus_attr_ignore_drivers, NULL }; fw_attr(ne, struct node_entry, capabilities, unsigned int, "0x%06x ") fw_attr(ne, struct node_entry, nodeid, unsigned int, "0x%04x ") fw_attr(ne, struct node_entry, vendor_id, unsigned int, "0x%06x ") fw_attr_td(ne, struct node_entry, vendor_name_kv) |
1da177e4c Linux-2.6.12-rc2 |
416 417 418 419 420 |
fw_attr(ne, struct node_entry, guid, unsigned long long, "0x%016Lx ") fw_attr(ne, struct node_entry, guid_vendor_id, unsigned int, "0x%06x ") |
1da177e4c Linux-2.6.12-rc2 |
421 422 423 424 425 426 427 428 429 430 |
fw_attr(ne, struct node_entry, in_limbo, int, "%d "); static struct device_attribute *const fw_ne_attrs[] = { &dev_attr_ne_guid, &dev_attr_ne_guid_vendor_id, &dev_attr_ne_capabilities, &dev_attr_ne_vendor_id, &dev_attr_ne_nodeid, &dev_attr_bus_options, |
9951903e6 ieee1394: shrink ... |
431 |
#ifdef HPSB_DEBUG_TLABELS |
1da177e4c Linux-2.6.12-rc2 |
432 |
&dev_attr_tlabels_free, |
1da177e4c Linux-2.6.12-rc2 |
433 |
&dev_attr_tlabels_mask, |
9951903e6 ieee1394: shrink ... |
434 |
#endif |
1da177e4c Linux-2.6.12-rc2 |
435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 |
}; fw_attr(ud, struct unit_directory, address, unsigned long long, "0x%016Lx ") fw_attr(ud, struct unit_directory, length, int, "%d ") /* These are all dependent on the value being provided */ fw_attr(ud, struct unit_directory, vendor_id, unsigned int, "0x%06x ") fw_attr(ud, struct unit_directory, model_id, unsigned int, "0x%06x ") fw_attr(ud, struct unit_directory, specifier_id, unsigned int, "0x%06x ") fw_attr(ud, struct unit_directory, version, unsigned int, "0x%06x ") fw_attr_td(ud, struct unit_directory, vendor_name_kv) |
1da177e4c Linux-2.6.12-rc2 |
453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 |
fw_attr_td(ud, struct unit_directory, model_name_kv) static struct device_attribute *const fw_ud_attrs[] = { &dev_attr_ud_address, &dev_attr_ud_length, &dev_attr_ignore_driver, }; fw_attr(host, struct hpsb_host, node_count, int, "%d ") fw_attr(host, struct hpsb_host, selfid_count, int, "%d ") fw_attr(host, struct hpsb_host, nodes_active, int, "%d ") fw_attr(host, struct hpsb_host, in_bus_reset, int, "%d ") fw_attr(host, struct hpsb_host, is_root, int, "%d ") fw_attr(host, struct hpsb_host, is_cycmst, int, "%d ") fw_attr(host, struct hpsb_host, is_irm, int, "%d ") fw_attr(host, struct hpsb_host, is_busmgr, int, "%d ") static struct device_attribute *const fw_host_attrs[] = { &dev_attr_host_node_count, &dev_attr_host_selfid_count, &dev_attr_host_nodes_active, &dev_attr_host_in_bus_reset, &dev_attr_host_is_root, &dev_attr_host_is_cycmst, &dev_attr_host_is_irm, &dev_attr_host_is_busmgr, }; static ssize_t fw_show_drv_device_ids(struct device_driver *drv, char *buf) { struct hpsb_protocol_driver *driver; |
c64094684 ieee1394: constif... |
494 |
const struct ieee1394_device_id *id; |
1da177e4c Linux-2.6.12-rc2 |
495 496 |
int length = 0; char *scratch = buf; |
d41bba2d3 ieee1394: nodemgr... |
497 |
driver = container_of(drv, struct hpsb_protocol_driver, driver); |
07c7224cf ieee1394: fix NUL... |
498 499 500 |
id = driver->id_table; if (!id) return 0; |
1da177e4c Linux-2.6.12-rc2 |
501 |
|
07c7224cf ieee1394: fix NUL... |
502 |
for (; id->match_flags != 0; id++) { |
1da177e4c Linux-2.6.12-rc2 |
503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 |
int need_coma = 0; if (id->match_flags & IEEE1394_MATCH_VENDOR_ID) { length += sprintf(scratch, "vendor_id=0x%06x", id->vendor_id); scratch = buf + length; need_coma++; } if (id->match_flags & IEEE1394_MATCH_MODEL_ID) { length += sprintf(scratch, "%smodel_id=0x%06x", need_coma++ ? "," : "", id->model_id); scratch = buf + length; } if (id->match_flags & IEEE1394_MATCH_SPECIFIER_ID) { length += sprintf(scratch, "%sspecifier_id=0x%06x", need_coma++ ? "," : "", id->specifier_id); scratch = buf + length; } if (id->match_flags & IEEE1394_MATCH_VERSION) { length += sprintf(scratch, "%sversion=0x%06x", need_coma++ ? "," : "", id->version); scratch = buf + length; } if (need_coma) { *scratch++ = ' '; length++; } } return length; } static DRIVER_ATTR(device_ids,S_IRUGO,fw_show_drv_device_ids,NULL); fw_drv_attr(name, const char *, "%s ") static struct driver_attribute *const fw_drv_attrs[] = { &driver_attr_drv_name, &driver_attr_device_ids, }; static void nodemgr_create_drv_files(struct hpsb_protocol_driver *driver) { struct device_driver *drv = &driver->driver; int i; for (i = 0; i < ARRAY_SIZE(fw_drv_attrs); i++) |
c1c9c7cd9 ieee1394: handle ... |
559 560 561 562 |
if (driver_create_file(drv, fw_drv_attrs[i])) goto fail; return; fail: |
9be51c5d7 ieee1394: nodemgr... |
563 |
HPSB_ERR("Failed to add sysfs attribute"); |
1da177e4c Linux-2.6.12-rc2 |
564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 |
} static void nodemgr_remove_drv_files(struct hpsb_protocol_driver *driver) { struct device_driver *drv = &driver->driver; int i; for (i = 0; i < ARRAY_SIZE(fw_drv_attrs); i++) driver_remove_file(drv, fw_drv_attrs[i]); } static void nodemgr_create_ne_dev_files(struct node_entry *ne) { struct device *dev = &ne->device; int i; for (i = 0; i < ARRAY_SIZE(fw_ne_attrs); i++) |
c1c9c7cd9 ieee1394: handle ... |
583 584 585 586 |
if (device_create_file(dev, fw_ne_attrs[i])) goto fail; return; fail: |
9be51c5d7 ieee1394: nodemgr... |
587 |
HPSB_ERR("Failed to add sysfs attribute"); |
1da177e4c Linux-2.6.12-rc2 |
588 589 590 591 592 593 594 595 596 |
} static void nodemgr_create_host_dev_files(struct hpsb_host *host) { struct device *dev = &host->device; int i; for (i = 0; i < ARRAY_SIZE(fw_host_attrs); i++) |
c1c9c7cd9 ieee1394: handle ... |
597 598 599 600 |
if (device_create_file(dev, fw_host_attrs[i])) goto fail; return; fail: |
9be51c5d7 ieee1394: nodemgr... |
601 |
HPSB_ERR("Failed to add sysfs attribute"); |
1da177e4c Linux-2.6.12-rc2 |
602 |
} |
c1c9c7cd9 ieee1394: handle ... |
603 604 |
static struct node_entry *find_entry_by_nodeid(struct hpsb_host *host, nodeid_t nodeid); |
1da177e4c Linux-2.6.12-rc2 |
605 606 607 608 609 610 611 612 613 |
static void nodemgr_update_host_dev_links(struct hpsb_host *host) { struct device *dev = &host->device; struct node_entry *ne; sysfs_remove_link(&dev->kobj, "irm_id"); sysfs_remove_link(&dev->kobj, "busmgr_id"); sysfs_remove_link(&dev->kobj, "host_id"); |
c1c9c7cd9 ieee1394: handle ... |
614 615 616 617 618 619 620 621 622 623 624 625 |
if ((ne = find_entry_by_nodeid(host, host->irm_id)) && sysfs_create_link(&dev->kobj, &ne->device.kobj, "irm_id")) goto fail; if ((ne = find_entry_by_nodeid(host, host->busmgr_id)) && sysfs_create_link(&dev->kobj, &ne->device.kobj, "busmgr_id")) goto fail; if ((ne = find_entry_by_nodeid(host, host->node_id)) && sysfs_create_link(&dev->kobj, &ne->device.kobj, "host_id")) goto fail; return; fail: HPSB_ERR("Failed to update sysfs attributes for host %d", host->id); |
1da177e4c Linux-2.6.12-rc2 |
626 627 628 629 630 631 632 633 |
} static void nodemgr_create_ud_dev_files(struct unit_directory *ud) { struct device *dev = &ud->device; int i; for (i = 0; i < ARRAY_SIZE(fw_ud_attrs); i++) |
c1c9c7cd9 ieee1394: handle ... |
634 635 |
if (device_create_file(dev, fw_ud_attrs[i])) goto fail; |
1da177e4c Linux-2.6.12-rc2 |
636 |
if (ud->flags & UNIT_DIRECTORY_SPECIFIER_ID) |
c1c9c7cd9 ieee1394: handle ... |
637 638 |
if (device_create_file(dev, &dev_attr_ud_specifier_id)) goto fail; |
1da177e4c Linux-2.6.12-rc2 |
639 |
if (ud->flags & UNIT_DIRECTORY_VERSION) |
c1c9c7cd9 ieee1394: handle ... |
640 641 |
if (device_create_file(dev, &dev_attr_ud_version)) goto fail; |
1da177e4c Linux-2.6.12-rc2 |
642 |
if (ud->flags & UNIT_DIRECTORY_VENDOR_ID) { |
c1c9c7cd9 ieee1394: handle ... |
643 644 645 646 647 |
if (device_create_file(dev, &dev_attr_ud_vendor_id)) goto fail; if (ud->vendor_name_kv && device_create_file(dev, &dev_attr_ud_vendor_name_kv)) goto fail; |
1da177e4c Linux-2.6.12-rc2 |
648 |
} |
1da177e4c Linux-2.6.12-rc2 |
649 |
if (ud->flags & UNIT_DIRECTORY_MODEL_ID) { |
c1c9c7cd9 ieee1394: handle ... |
650 651 652 653 654 |
if (device_create_file(dev, &dev_attr_ud_model_id)) goto fail; if (ud->model_name_kv && device_create_file(dev, &dev_attr_ud_model_name_kv)) goto fail; |
1da177e4c Linux-2.6.12-rc2 |
655 |
} |
c1c9c7cd9 ieee1394: handle ... |
656 657 |
return; fail: |
9be51c5d7 ieee1394: nodemgr... |
658 |
HPSB_ERR("Failed to add sysfs attribute"); |
1da177e4c Linux-2.6.12-rc2 |
659 660 661 662 663 |
} static int nodemgr_bus_match(struct device * dev, struct device_driver * drv) { |
d41bba2d3 ieee1394: nodemgr... |
664 665 |
struct hpsb_protocol_driver *driver; struct unit_directory *ud; |
c64094684 ieee1394: constif... |
666 |
const struct ieee1394_device_id *id; |
1da177e4c Linux-2.6.12-rc2 |
667 668 669 670 671 672 |
/* We only match unit directories */ if (dev->platform_data != &nodemgr_ud_platform_data) return 0; ud = container_of(dev, struct unit_directory, device); |
1da177e4c Linux-2.6.12-rc2 |
673 674 |
if (ud->ne->in_limbo || ud->ignore_driver) return 0; |
8252bbb13 ieee1394: nodemgr... |
675 676 677 678 679 |
/* We only match drivers of type hpsb_protocol_driver */ if (drv == &nodemgr_mid_layer_driver) return 0; driver = container_of(drv, struct hpsb_protocol_driver, driver); |
d2ace29fa ieee1394: prevent... |
680 681 682 683 684 |
id = driver->id_table; if (!id) return 0; for (; id->match_flags != 0; id++) { |
d41bba2d3 ieee1394: nodemgr... |
685 686 687 |
if ((id->match_flags & IEEE1394_MATCH_VENDOR_ID) && id->vendor_id != ud->vendor_id) continue; |
1da177e4c Linux-2.6.12-rc2 |
688 |
|
d41bba2d3 ieee1394: nodemgr... |
689 690 691 |
if ((id->match_flags & IEEE1394_MATCH_MODEL_ID) && id->model_id != ud->model_id) continue; |
1da177e4c Linux-2.6.12-rc2 |
692 |
|
d41bba2d3 ieee1394: nodemgr... |
693 694 695 |
if ((id->match_flags & IEEE1394_MATCH_SPECIFIER_ID) && id->specifier_id != ud->specifier_id) continue; |
1da177e4c Linux-2.6.12-rc2 |
696 |
|
d41bba2d3 ieee1394: nodemgr... |
697 698 699 |
if ((id->match_flags & IEEE1394_MATCH_VERSION) && id->version != ud->version) continue; |
1da177e4c Linux-2.6.12-rc2 |
700 701 |
return 1; |
d41bba2d3 ieee1394: nodemgr... |
702 |
} |
1da177e4c Linux-2.6.12-rc2 |
703 704 705 |
return 0; } |
b07375b15 ieee1394: nodemgr... |
706 |
static DEFINE_MUTEX(nodemgr_serialize_remove_uds); |
11305c3ed ieee1394: nodemgr... |
707 |
static int match_ne(struct device *dev, void *data) |
73cf60232 ieee1394: use cla... |
708 709 |
{ struct unit_directory *ud; |
11305c3ed ieee1394: nodemgr... |
710 |
struct node_entry *ne = data; |
73cf60232 ieee1394: use cla... |
711 712 713 714 |
ud = container_of(dev, struct unit_directory, unit_dev); return ud->ne == ne; } |
1da177e4c Linux-2.6.12-rc2 |
715 716 |
static void nodemgr_remove_uds(struct node_entry *ne) { |
dd7f2928d ieee1394: convert... |
717 |
struct device *dev; |
73cf60232 ieee1394: use cla... |
718 719 720 721 722 |
struct unit_directory *ud; /* Use class_find device to iterate the devices. Since this code * may be called from other contexts besides the knodemgrds, * protect it by nodemgr_serialize_remove_uds. |
b07375b15 ieee1394: nodemgr... |
723 |
*/ |
b07375b15 ieee1394: nodemgr... |
724 |
mutex_lock(&nodemgr_serialize_remove_uds); |
1e4f7bc8f ieee1394: nodemgr... |
725 |
for (;;) { |
11305c3ed ieee1394: nodemgr... |
726 |
dev = class_find_device(&nodemgr_ud_class, NULL, ne, match_ne); |
73cf60232 ieee1394: use cla... |
727 |
if (!dev) |
1e4f7bc8f ieee1394: nodemgr... |
728 |
break; |
73cf60232 ieee1394: use cla... |
729 730 |
ud = container_of(dev, struct unit_directory, unit_dev); put_device(dev); |
dd7f2928d ieee1394: convert... |
731 |
device_unregister(&ud->unit_dev); |
1e4f7bc8f ieee1394: nodemgr... |
732 |
device_unregister(&ud->device); |
b07375b15 ieee1394: nodemgr... |
733 |
} |
b07375b15 ieee1394: nodemgr... |
734 |
mutex_unlock(&nodemgr_serialize_remove_uds); |
1da177e4c Linux-2.6.12-rc2 |
735 736 737 738 739 |
} static void nodemgr_remove_ne(struct node_entry *ne) { |
cec1a3119 ieee1394: nodemgr... |
740 |
struct device *dev; |
1da177e4c Linux-2.6.12-rc2 |
741 742 743 744 745 746 747 |
dev = get_device(&ne->device); if (!dev) return; HPSB_DEBUG("Node removed: ID:BUS[" NODE_BUS_FMT "] GUID[%016Lx]", NODE_BUS_ARGS(ne->host, ne->nodeid), (unsigned long long)ne->guid); |
1da177e4c Linux-2.6.12-rc2 |
748 |
nodemgr_remove_uds(ne); |
dd7f2928d ieee1394: convert... |
749 |
device_unregister(&ne->node_dev); |
1da177e4c Linux-2.6.12-rc2 |
750 751 752 753 |
device_unregister(dev); put_device(dev); } |
11305c3ed ieee1394: nodemgr... |
754 |
static int remove_host_dev(struct device *dev, void *data) |
64360322a [PATCH] Use devic... |
755 |
{ |
dd7f2928d ieee1394: convert... |
756 757 758 |
if (dev->bus == &ieee1394_bus_type) nodemgr_remove_ne(container_of(dev, struct node_entry, device)); |
64360322a [PATCH] Use devic... |
759 760 |
return 0; } |
1da177e4c Linux-2.6.12-rc2 |
761 762 763 |
static void nodemgr_remove_host_dev(struct device *dev) { |
11305c3ed ieee1394: nodemgr... |
764 |
device_for_each_child(dev, NULL, remove_host_dev); |
1da177e4c Linux-2.6.12-rc2 |
765 766 767 768 769 770 771 772 773 774 775 776 |
sysfs_remove_link(&dev->kobj, "irm_id"); sysfs_remove_link(&dev->kobj, "busmgr_id"); sysfs_remove_link(&dev->kobj, "host_id"); } static void nodemgr_update_bus_options(struct node_entry *ne) { #ifdef CONFIG_IEEE1394_VERBOSEDEBUG static const u16 mr[] = { 4, 64, 1024, 0}; #endif quadlet_t busoptions = be32_to_cpu(ne->csr->bus_info_data[2]); |
d41bba2d3 ieee1394: nodemgr... |
777 778 779 780 781 782 783 |
ne->busopt.irmc = (busoptions >> 31) & 1; ne->busopt.cmc = (busoptions >> 30) & 1; ne->busopt.isc = (busoptions >> 29) & 1; ne->busopt.bmc = (busoptions >> 28) & 1; ne->busopt.pmc = (busoptions >> 27) & 1; ne->busopt.cyc_clk_acc = (busoptions >> 16) & 0xff; ne->busopt.max_rec = 1 << (((busoptions >> 12) & 0xf) + 1); |
1da177e4c Linux-2.6.12-rc2 |
784 |
ne->busopt.max_rom = (busoptions >> 8) & 0x3; |
d41bba2d3 ieee1394: nodemgr... |
785 786 |
ne->busopt.generation = (busoptions >> 4) & 0xf; ne->busopt.lnkspd = busoptions & 0x7; |
1da177e4c Linux-2.6.12-rc2 |
787 788 789 790 791 792 793 794 795 |
HPSB_VERBOSE("NodeMgr: raw=0x%08x irmc=%d cmc=%d isc=%d bmc=%d pmc=%d " "cyc_clk_acc=%d max_rec=%d max_rom=%d gen=%d lspd=%d", busoptions, ne->busopt.irmc, ne->busopt.cmc, ne->busopt.isc, ne->busopt.bmc, ne->busopt.pmc, ne->busopt.cyc_clk_acc, ne->busopt.max_rec, mr[ne->busopt.max_rom], ne->busopt.generation, ne->busopt.lnkspd); } |
11305c3ed ieee1394: nodemgr... |
796 797 798 |
static struct node_entry *nodemgr_create_node(octlet_t guid, struct csr1212_csr *csr, struct hpsb_host *host, nodeid_t nodeid, unsigned int generation) |
1da177e4c Linux-2.6.12-rc2 |
799 |
{ |
8551158ab kmalloc/kzalloc c... |
800 |
struct node_entry *ne; |
1da177e4c Linux-2.6.12-rc2 |
801 |
|
8551158ab kmalloc/kzalloc c... |
802 803 |
ne = kzalloc(sizeof(*ne), GFP_KERNEL); if (!ne) |
c1c9c7cd9 ieee1394: handle ... |
804 |
goto fail_alloc; |
1da177e4c Linux-2.6.12-rc2 |
805 |
|
8551158ab kmalloc/kzalloc c... |
806 807 |
ne->host = host; ne->nodeid = nodeid; |
1da177e4c Linux-2.6.12-rc2 |
808 |
ne->generation = generation; |
6848408ab ieee1394: regress... |
809 |
ne->needs_probe = true; |
1da177e4c Linux-2.6.12-rc2 |
810 |
|
8551158ab kmalloc/kzalloc c... |
811 |
ne->guid = guid; |
1da177e4c Linux-2.6.12-rc2 |
812 |
ne->guid_vendor_id = (guid >> 40) & 0xffffff; |
1da177e4c Linux-2.6.12-rc2 |
813 814 815 816 817 |
ne->csr = csr; memcpy(&ne->device, &nodemgr_dev_template_ne, sizeof(ne->device)); ne->device.parent = &host->device; |
233976e53 ieee1394: struct ... |
818 |
dev_set_name(&ne->device, "%016Lx", (unsigned long long)(ne->guid)); |
1da177e4c Linux-2.6.12-rc2 |
819 |
|
dd7f2928d ieee1394: convert... |
820 821 |
ne->node_dev.parent = &ne->device; ne->node_dev.class = &nodemgr_ne_class; |
233976e53 ieee1394: struct ... |
822 |
dev_set_name(&ne->node_dev, "%016Lx", (unsigned long long)(ne->guid)); |
1da177e4c Linux-2.6.12-rc2 |
823 |
|
c1c9c7cd9 ieee1394: handle ... |
824 825 |
if (device_register(&ne->device)) goto fail_devreg; |
dd7f2928d ieee1394: convert... |
826 |
if (device_register(&ne->node_dev)) |
c1c9c7cd9 ieee1394: handle ... |
827 |
goto fail_classdevreg; |
1da177e4c Linux-2.6.12-rc2 |
828 |
get_device(&ne->device); |
1da177e4c Linux-2.6.12-rc2 |
829 830 831 832 833 834 835 |
nodemgr_create_ne_dev_files(ne); nodemgr_update_bus_options(ne); HPSB_DEBUG("%s added: ID:BUS[" NODE_BUS_FMT "] GUID[%016Lx]", (host->node_id == nodeid) ? "Host" : "Node", NODE_BUS_ARGS(host, nodeid), (unsigned long long)guid); |
8551158ab kmalloc/kzalloc c... |
836 |
return ne; |
c1c9c7cd9 ieee1394: handle ... |
837 |
|
c1c9c7cd9 ieee1394: handle ... |
838 839 840 841 842 843 844 845 846 |
fail_classdevreg: device_unregister(&ne->device); fail_devreg: kfree(ne); fail_alloc: HPSB_ERR("Failed to create node ID:BUS[" NODE_BUS_FMT "] GUID[%016Lx]", NODE_BUS_ARGS(host, nodeid), (unsigned long long)guid); return NULL; |
1da177e4c Linux-2.6.12-rc2 |
847 |
} |
11305c3ed ieee1394: nodemgr... |
848 |
static int match_ne_guid(struct device *dev, void *data) |
73cf60232 ieee1394: use cla... |
849 850 |
{ struct node_entry *ne; |
11305c3ed ieee1394: nodemgr... |
851 |
u64 *guid = data; |
73cf60232 ieee1394: use cla... |
852 853 854 855 |
ne = container_of(dev, struct node_entry, node_dev); return ne->guid == *guid; } |
1da177e4c Linux-2.6.12-rc2 |
856 857 858 |
static struct node_entry *find_entry_by_guid(u64 guid) { |
dd7f2928d ieee1394: convert... |
859 |
struct device *dev; |
73cf60232 ieee1394: use cla... |
860 |
struct node_entry *ne; |
1da177e4c Linux-2.6.12-rc2 |
861 |
|
11305c3ed ieee1394: nodemgr... |
862 |
dev = class_find_device(&nodemgr_ne_class, NULL, &guid, match_ne_guid); |
73cf60232 ieee1394: use cla... |
863 864 865 866 |
if (!dev) return NULL; ne = container_of(dev, struct node_entry, node_dev); put_device(dev); |
1da177e4c Linux-2.6.12-rc2 |
867 |
|
73cf60232 ieee1394: use cla... |
868 |
return ne; |
1da177e4c Linux-2.6.12-rc2 |
869 |
} |
11305c3ed ieee1394: nodemgr... |
870 |
struct match_nodeid_parameter { |
73cf60232 ieee1394: use cla... |
871 872 873 |
struct hpsb_host *host; nodeid_t nodeid; }; |
11305c3ed ieee1394: nodemgr... |
874 |
static int match_ne_nodeid(struct device *dev, void *data) |
73cf60232 ieee1394: use cla... |
875 876 877 |
{ int found = 0; struct node_entry *ne; |
11305c3ed ieee1394: nodemgr... |
878 |
struct match_nodeid_parameter *p = data; |
73cf60232 ieee1394: use cla... |
879 880 881 882 |
if (!dev) goto ret; ne = container_of(dev, struct node_entry, node_dev); |
11305c3ed ieee1394: nodemgr... |
883 |
if (ne->host == p->host && ne->nodeid == p->nodeid) |
73cf60232 ieee1394: use cla... |
884 885 886 887 |
found = 1; ret: return found; } |
1da177e4c Linux-2.6.12-rc2 |
888 |
|
b07375b15 ieee1394: nodemgr... |
889 890 |
static struct node_entry *find_entry_by_nodeid(struct hpsb_host *host, nodeid_t nodeid) |
1da177e4c Linux-2.6.12-rc2 |
891 |
{ |
dd7f2928d ieee1394: convert... |
892 |
struct device *dev; |
73cf60232 ieee1394: use cla... |
893 |
struct node_entry *ne; |
11305c3ed ieee1394: nodemgr... |
894 |
struct match_nodeid_parameter p; |
1da177e4c Linux-2.6.12-rc2 |
895 |
|
11305c3ed ieee1394: nodemgr... |
896 897 |
p.host = host; p.nodeid = nodeid; |
1da177e4c Linux-2.6.12-rc2 |
898 |
|
11305c3ed ieee1394: nodemgr... |
899 |
dev = class_find_device(&nodemgr_ne_class, NULL, &p, match_ne_nodeid); |
73cf60232 ieee1394: use cla... |
900 901 902 903 |
if (!dev) return NULL; ne = container_of(dev, struct node_entry, node_dev); put_device(dev); |
1da177e4c Linux-2.6.12-rc2 |
904 |
|
73cf60232 ieee1394: use cla... |
905 |
return ne; |
1da177e4c Linux-2.6.12-rc2 |
906 907 908 909 910 911 912 913 914 915 |
} static void nodemgr_register_device(struct node_entry *ne, struct unit_directory *ud, struct device *parent) { memcpy(&ud->device, &nodemgr_dev_template_ud, sizeof(ud->device)); ud->device.parent = parent; |
233976e53 ieee1394: struct ... |
916 |
dev_set_name(&ud->device, "%s-%u", dev_name(&ne->device), ud->id); |
1da177e4c Linux-2.6.12-rc2 |
917 |
|
dd7f2928d ieee1394: convert... |
918 919 |
ud->unit_dev.parent = &ud->device; ud->unit_dev.class = &nodemgr_ud_class; |
233976e53 ieee1394: struct ... |
920 |
dev_set_name(&ud->unit_dev, "%s-%u", dev_name(&ne->device), ud->id); |
1da177e4c Linux-2.6.12-rc2 |
921 |
|
c1c9c7cd9 ieee1394: handle ... |
922 923 |
if (device_register(&ud->device)) goto fail_devreg; |
dd7f2928d ieee1394: convert... |
924 |
if (device_register(&ud->unit_dev)) |
c1c9c7cd9 ieee1394: handle ... |
925 |
goto fail_classdevreg; |
1da177e4c Linux-2.6.12-rc2 |
926 |
get_device(&ud->device); |
1da177e4c Linux-2.6.12-rc2 |
927 |
nodemgr_create_ud_dev_files(ud); |
c1c9c7cd9 ieee1394: handle ... |
928 929 |
return; |
c1c9c7cd9 ieee1394: handle ... |
930 931 932 |
fail_classdevreg: device_unregister(&ud->device); fail_devreg: |
233976e53 ieee1394: struct ... |
933 |
HPSB_ERR("Failed to create unit %s", dev_name(&ud->device)); |
1da177e4c Linux-2.6.12-rc2 |
934 935 936 937 938 939 940 |
} /* This implementation currently only scans the config rom and its * immediate unit directories looking for software_id and * software_version entries, in order to get driver autoloading working. */ static struct unit_directory *nodemgr_process_unit_directory |
11305c3ed ieee1394: nodemgr... |
941 |
(struct node_entry *ne, struct csr1212_keyval *ud_kv, |
1da177e4c Linux-2.6.12-rc2 |
942 943 944 945 946 947 948 |
unsigned int *id, struct unit_directory *parent) { struct unit_directory *ud; struct unit_directory *ud_child = NULL; struct csr1212_dentry *dentry; struct csr1212_keyval *kv; u8 last_key_id = 0; |
8551158ab kmalloc/kzalloc c... |
949 |
ud = kzalloc(sizeof(*ud), GFP_KERNEL); |
1da177e4c Linux-2.6.12-rc2 |
950 951 |
if (!ud) goto unit_directory_error; |
1da177e4c Linux-2.6.12-rc2 |
952 953 |
ud->ne = ne; ud->ignore_driver = ignore_drivers; |
a52938f3e ieee1394: fix cal... |
954 |
ud->address = ud_kv->offset + CSR1212_REGISTER_SPACE_BASE; |
d7794c866 ieee1394: sbp2: o... |
955 |
ud->directory_id = ud->address & 0xffffff; |
1da177e4c Linux-2.6.12-rc2 |
956 957 |
ud->ud_kv = ud_kv; ud->id = (*id)++; |
9c939e4df ieee1394: inherit... |
958 959 |
/* inherit vendor_id from root directory if none exists in unit dir */ ud->vendor_id = ne->vendor_id; |
1da177e4c Linux-2.6.12-rc2 |
960 961 962 963 964 965 |
csr1212_for_each_dir_entry(ne->csr, kv, ud_kv, dentry) { switch (kv->key.id) { case CSR1212_KV_ID_VENDOR: if (kv->key.type == CSR1212_KV_TYPE_IMMEDIATE) { ud->vendor_id = kv->value.immediate; ud->flags |= UNIT_DIRECTORY_VENDOR_ID; |
1da177e4c Linux-2.6.12-rc2 |
966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 |
} break; case CSR1212_KV_ID_MODEL: ud->model_id = kv->value.immediate; ud->flags |= UNIT_DIRECTORY_MODEL_ID; break; case CSR1212_KV_ID_SPECIFIER_ID: ud->specifier_id = kv->value.immediate; ud->flags |= UNIT_DIRECTORY_SPECIFIER_ID; break; case CSR1212_KV_ID_VERSION: ud->version = kv->value.immediate; ud->flags |= UNIT_DIRECTORY_VERSION; break; case CSR1212_KV_ID_DESCRIPTOR: if (kv->key.type == CSR1212_KV_TYPE_LEAF && CSR1212_DESCRIPTOR_LEAF_TYPE(kv) == 0 && CSR1212_DESCRIPTOR_LEAF_SPECIFIER_ID(kv) == 0 && CSR1212_TEXTUAL_DESCRIPTOR_LEAF_WIDTH(kv) == 0 && CSR1212_TEXTUAL_DESCRIPTOR_LEAF_CHAR_SET(kv) == 0 && CSR1212_TEXTUAL_DESCRIPTOR_LEAF_LANGUAGE(kv) == 0) { switch (last_key_id) { case CSR1212_KV_ID_VENDOR: |
1da177e4c Linux-2.6.12-rc2 |
993 |
csr1212_keep_keyval(kv); |
17a19b795 ieee1394: csr1212... |
994 |
ud->vendor_name_kv = kv; |
1da177e4c Linux-2.6.12-rc2 |
995 996 997 |
break; case CSR1212_KV_ID_MODEL: |
1da177e4c Linux-2.6.12-rc2 |
998 |
csr1212_keep_keyval(kv); |
17a19b795 ieee1394: csr1212... |
999 |
ud->model_name_kv = kv; |
1da177e4c Linux-2.6.12-rc2 |
1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 |
break; } } /* else if (kv->key.type == CSR1212_KV_TYPE_DIRECTORY) ... */ break; case CSR1212_KV_ID_DEPENDENT_INFO: /* Logical Unit Number */ if (kv->key.type == CSR1212_KV_TYPE_IMMEDIATE) { if (ud->flags & UNIT_DIRECTORY_HAS_LUN) { |
bfe89d724 drivers/ieee1394/... |
1010 |
ud_child = kmemdup(ud, sizeof(*ud_child), GFP_KERNEL); |
1da177e4c Linux-2.6.12-rc2 |
1011 1012 |
if (!ud_child) goto unit_directory_error; |
1da177e4c Linux-2.6.12-rc2 |
1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 |
nodemgr_register_device(ne, ud_child, &ne->device); ud_child = NULL; ud->id = (*id)++; } ud->lun = kv->value.immediate; ud->flags |= UNIT_DIRECTORY_HAS_LUN; /* Logical Unit Directory */ } else if (kv->key.type == CSR1212_KV_TYPE_DIRECTORY) { /* This should really be done in SBP2 as this is * doing SBP2 specific parsing. */ /* first register the parent unit */ ud->flags |= UNIT_DIRECTORY_HAS_LUN_DIRECTORY; if (ud->device.bus != &ieee1394_bus_type) nodemgr_register_device(ne, ud, &ne->device); /* process the child unit */ |
11305c3ed ieee1394: nodemgr... |
1033 |
ud_child = nodemgr_process_unit_directory(ne, kv, id, ud); |
1da177e4c Linux-2.6.12-rc2 |
1034 1035 1036 1037 |
if (ud_child == NULL) break; |
312c004d3 [PATCH] driver co... |
1038 |
/* inherit unspecified values, the driver core picks it up */ |
1da177e4c Linux-2.6.12-rc2 |
1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 |
if ((ud->flags & UNIT_DIRECTORY_MODEL_ID) && !(ud_child->flags & UNIT_DIRECTORY_MODEL_ID)) { ud_child->flags |= UNIT_DIRECTORY_MODEL_ID; ud_child->model_id = ud->model_id; } if ((ud->flags & UNIT_DIRECTORY_SPECIFIER_ID) && !(ud_child->flags & UNIT_DIRECTORY_SPECIFIER_ID)) { ud_child->flags |= UNIT_DIRECTORY_SPECIFIER_ID; ud_child->specifier_id = ud->specifier_id; } if ((ud->flags & UNIT_DIRECTORY_VERSION) && !(ud_child->flags & UNIT_DIRECTORY_VERSION)) { ud_child->flags |= UNIT_DIRECTORY_VERSION; ud_child->version = ud->version; } /* register the child unit */ ud_child->flags |= UNIT_DIRECTORY_LUN_DIRECTORY; nodemgr_register_device(ne, ud_child, &ud->device); } break; |
d7794c866 ieee1394: sbp2: o... |
1064 1065 1066 |
case CSR1212_KV_ID_DIRECTORY_ID: ud->directory_id = kv->value.immediate; break; |
1da177e4c Linux-2.6.12-rc2 |
1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 |
default: break; } last_key_id = kv->key.id; } /* do not process child units here and only if not already registered */ if (!parent && ud->device.bus != &ieee1394_bus_type) nodemgr_register_device(ne, ud, &ne->device); return ud; unit_directory_error: |
616b859fb [PATCH] ieee1394:... |
1080 |
kfree(ud); |
1da177e4c Linux-2.6.12-rc2 |
1081 1082 |
return NULL; } |
11305c3ed ieee1394: nodemgr... |
1083 |
static void nodemgr_process_root_directory(struct node_entry *ne) |
1da177e4c Linux-2.6.12-rc2 |
1084 1085 1086 |
{ unsigned int ud_id = 0; struct csr1212_dentry *dentry; |
638d5bb81 ieee1394: nodemgr... |
1087 |
struct csr1212_keyval *kv, *vendor_name_kv = NULL; |
1da177e4c Linux-2.6.12-rc2 |
1088 |
u8 last_key_id = 0; |
6848408ab ieee1394: regress... |
1089 |
ne->needs_probe = false; |
1da177e4c Linux-2.6.12-rc2 |
1090 1091 1092 1093 1094 |
csr1212_for_each_dir_entry(ne->csr, kv, ne->csr->root_kv, dentry) { switch (kv->key.id) { case CSR1212_KV_ID_VENDOR: ne->vendor_id = kv->value.immediate; |
1da177e4c Linux-2.6.12-rc2 |
1095 1096 1097 1098 1099 1100 1101 |
break; case CSR1212_KV_ID_NODE_CAPABILITIES: ne->capabilities = kv->value.immediate; break; case CSR1212_KV_ID_UNIT: |
11305c3ed ieee1394: nodemgr... |
1102 |
nodemgr_process_unit_directory(ne, kv, &ud_id, NULL); |
1da177e4c Linux-2.6.12-rc2 |
1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 |
break; case CSR1212_KV_ID_DESCRIPTOR: if (last_key_id == CSR1212_KV_ID_VENDOR) { if (kv->key.type == CSR1212_KV_TYPE_LEAF && CSR1212_DESCRIPTOR_LEAF_TYPE(kv) == 0 && CSR1212_DESCRIPTOR_LEAF_SPECIFIER_ID(kv) == 0 && CSR1212_TEXTUAL_DESCRIPTOR_LEAF_WIDTH(kv) == 0 && CSR1212_TEXTUAL_DESCRIPTOR_LEAF_CHAR_SET(kv) == 0 && CSR1212_TEXTUAL_DESCRIPTOR_LEAF_LANGUAGE(kv) == 0) { |
1da177e4c Linux-2.6.12-rc2 |
1113 |
csr1212_keep_keyval(kv); |
638d5bb81 ieee1394: nodemgr... |
1114 |
vendor_name_kv = kv; |
1da177e4c Linux-2.6.12-rc2 |
1115 1116 1117 1118 1119 1120 |
} } break; } last_key_id = kv->key.id; } |
932454723 ieee1394: nodemgr... |
1121 |
if (ne->vendor_name_kv) { |
638d5bb81 ieee1394: nodemgr... |
1122 1123 1124 1125 1126 1127 1128 |
kv = ne->vendor_name_kv; ne->vendor_name_kv = vendor_name_kv; csr1212_release_keyval(kv); } else if (vendor_name_kv) { ne->vendor_name_kv = vendor_name_kv; if (device_create_file(&ne->device, &dev_attr_ne_vendor_name_kv) != 0) |
9be51c5d7 ieee1394: nodemgr... |
1129 |
HPSB_ERR("Failed to add sysfs attribute"); |
932454723 ieee1394: nodemgr... |
1130 |
} |
1da177e4c Linux-2.6.12-rc2 |
1131 1132 1133 |
} #ifdef CONFIG_HOTPLUG |
7eff2e7a8 Driver core: chan... |
1134 |
static int nodemgr_uevent(struct device *dev, struct kobj_uevent_env *env) |
1da177e4c Linux-2.6.12-rc2 |
1135 1136 |
{ struct unit_directory *ud; |
bf62456eb uevent: use add_u... |
1137 |
int retval = 0; |
9b19d85ac [PATCH] provide M... |
1138 1139 |
/* ieee1394:venNmoNspNverN */ char buf[8 + 1 + 3 + 8 + 2 + 8 + 2 + 8 + 3 + 8 + 1]; |
1da177e4c Linux-2.6.12-rc2 |
1140 |
|
dd7f2928d ieee1394: convert... |
1141 |
if (!dev) |
1da177e4c Linux-2.6.12-rc2 |
1142 |
return -ENODEV; |
dd7f2928d ieee1394: convert... |
1143 |
ud = container_of(dev, struct unit_directory, unit_dev); |
1da177e4c Linux-2.6.12-rc2 |
1144 1145 1146 1147 1148 1149 |
if (ud->ne->in_limbo || ud->ignore_driver) return -ENODEV; #define PUT_ENVP(fmt,val) \ do { \ |
7eff2e7a8 Driver core: chan... |
1150 |
retval = add_uevent_var(env, fmt, val); \ |
bf62456eb uevent: use add_u... |
1151 1152 |
if (retval) \ return retval; \ |
1da177e4c Linux-2.6.12-rc2 |
1153 1154 1155 1156 1157 1158 1159 |
} while (0) PUT_ENVP("VENDOR_ID=%06x", ud->vendor_id); PUT_ENVP("MODEL_ID=%06x", ud->model_id); PUT_ENVP("GUID=%016Lx", (unsigned long long)ud->ne->guid); PUT_ENVP("SPECIFIER_ID=%06x", ud->specifier_id); PUT_ENVP("VERSION=%06x", ud->version); |
9b19d85ac [PATCH] provide M... |
1160 1161 1162 1163 1164 1165 |
snprintf(buf, sizeof(buf), "ieee1394:ven%08Xmo%08Xsp%08Xver%08X", ud->vendor_id, ud->model_id, ud->specifier_id, ud->version); PUT_ENVP("MODALIAS=%s", buf); |
1da177e4c Linux-2.6.12-rc2 |
1166 1167 |
#undef PUT_ENVP |
1da177e4c Linux-2.6.12-rc2 |
1168 1169 1170 1171 |
return 0; } #else |
7eff2e7a8 Driver core: chan... |
1172 |
static int nodemgr_uevent(struct device *dev, struct kobj_uevent_env *env) |
1da177e4c Linux-2.6.12-rc2 |
1173 1174 1175 1176 1177 |
{ return -ENODEV; } #endif /* CONFIG_HOTPLUG */ |
ed30c26ee ieee1394: Consoli... |
1178 1179 |
int __hpsb_register_protocol(struct hpsb_protocol_driver *drv, struct module *owner) |
1da177e4c Linux-2.6.12-rc2 |
1180 |
{ |
ed30c26ee ieee1394: Consoli... |
1181 1182 1183 1184 1185 |
int error; drv->driver.bus = &ieee1394_bus_type; drv->driver.owner = owner; drv->driver.name = drv->name; |
1da177e4c Linux-2.6.12-rc2 |
1186 |
/* This will cause a probe for devices */ |
ed30c26ee ieee1394: Consoli... |
1187 |
error = driver_register(&drv->driver); |
7fdfc9094 ieee1394: nodemgr... |
1188 |
if (!error) |
ed30c26ee ieee1394: Consoli... |
1189 |
nodemgr_create_drv_files(drv); |
7fdfc9094 ieee1394: nodemgr... |
1190 |
return error; |
1da177e4c Linux-2.6.12-rc2 |
1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 |
} void hpsb_unregister_protocol(struct hpsb_protocol_driver *driver) { nodemgr_remove_drv_files(driver); /* This will subsequently disconnect all devices that our driver * is attached to. */ driver_unregister(&driver->driver); } /* * This function updates nodes that were present on the bus before the * reset and still are after the reset. The nodeid and the config rom * may have changed, and the drivers managing this device must be * informed that this device just went through a bus reset, to allow * the to take whatever actions required. */ static void nodemgr_update_node(struct node_entry *ne, struct csr1212_csr *csr, |
11305c3ed ieee1394: nodemgr... |
1210 |
nodeid_t nodeid, unsigned int generation) |
1da177e4c Linux-2.6.12-rc2 |
1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 |
{ if (ne->nodeid != nodeid) { HPSB_DEBUG("Node changed: " NODE_BUS_FMT " -> " NODE_BUS_FMT, NODE_BUS_ARGS(ne->host, ne->nodeid), NODE_BUS_ARGS(ne->host, nodeid)); ne->nodeid = nodeid; } if (ne->busopt.generation != ((be32_to_cpu(csr->bus_info_data[2]) >> 4) & 0xf)) { kfree(ne->csr->private); csr1212_destroy_csr(ne->csr); ne->csr = csr; /* If the node's configrom generation has changed, we * unregister all the unit directories. */ nodemgr_remove_uds(ne); nodemgr_update_bus_options(ne); /* Mark the node as new, so it gets re-probed */ |
6848408ab ieee1394: regress... |
1231 |
ne->needs_probe = true; |
1da177e4c Linux-2.6.12-rc2 |
1232 1233 1234 1235 1236 1237 1238 1239 |
} else { /* old cache is valid, so update its generation */ struct nodemgr_csr_info *ci = ne->csr->private; ci->generation = generation; /* free the partially filled now unneeded new cache */ kfree(csr->private); csr1212_destroy_csr(csr); } |
29f8ea8ab ieee1394: use cor... |
1240 1241 |
/* Finally, mark the node current */ smp_wmb(); |
1da177e4c Linux-2.6.12-rc2 |
1242 |
ne->generation = generation; |
1da177e4c Linux-2.6.12-rc2 |
1243 |
|
fc392fe83 ieee1394: survive... |
1244 1245 1246 |
if (ne->in_limbo) { device_remove_file(&ne->device, &dev_attr_ne_in_limbo); ne->in_limbo = false; |
1da177e4c Linux-2.6.12-rc2 |
1247 |
|
fc392fe83 ieee1394: survive... |
1248 1249 1250 1251 1252 1253 |
HPSB_DEBUG("Node reactivated: " "ID:BUS[" NODE_BUS_FMT "] GUID[%016Lx]", NODE_BUS_ARGS(ne->host, ne->nodeid), (unsigned long long)ne->guid); } } |
1da177e4c Linux-2.6.12-rc2 |
1254 |
|
11305c3ed ieee1394: nodemgr... |
1255 |
static void nodemgr_node_scan_one(struct hpsb_host *host, |
1da177e4c Linux-2.6.12-rc2 |
1256 1257 |
nodeid_t nodeid, int generation) { |
1da177e4c Linux-2.6.12-rc2 |
1258 1259 1260 1261 |
struct node_entry *ne; octlet_t guid; struct csr1212_csr *csr; struct nodemgr_csr_info *ci; |
d7530a1e7 [PATCH] ieee1394:... |
1262 |
u8 *speed; |
1da177e4c Linux-2.6.12-rc2 |
1263 |
|
8551158ab kmalloc/kzalloc c... |
1264 |
ci = kmalloc(sizeof(*ci), GFP_KERNEL); |
004cdb5a7 ieee1394: annotat... |
1265 |
kmemcheck_annotate_bitfield(ci, flags); |
1da177e4c Linux-2.6.12-rc2 |
1266 1267 1268 1269 1270 1271 |
if (!ci) return; ci->host = host; ci->nodeid = nodeid; ci->generation = generation; |
d7530a1e7 [PATCH] ieee1394:... |
1272 1273 1274 1275 1276 1277 |
/* Prepare for speed probe which occurs when reading the ROM */ speed = &(host->speed[NODEID_TO_NODE(nodeid)]); if (*speed > host->csr.lnk_spd) *speed = host->csr.lnk_spd; ci->speed_unverified = *speed > IEEE1394_SPEED_100; |
1da177e4c Linux-2.6.12-rc2 |
1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 |
/* We need to detect when the ConfigROM's generation has changed, * so we only update the node's info when it needs to be. */ csr = csr1212_create_csr(&nodemgr_csr_ops, 5 * sizeof(quadlet_t), ci); if (!csr || csr1212_parse_csr(csr) != CSR1212_SUCCESS) { HPSB_ERR("Error parsing configrom for node " NODE_BUS_FMT, NODE_BUS_ARGS(host, nodeid)); if (csr) csr1212_destroy_csr(csr); kfree(ci); return; } if (csr->bus_info_data[1] != IEEE1394_BUSID_MAGIC) { /* This isn't a 1394 device, but we let it slide. There * was a report of a device with broken firmware which * reported '2394' instead of '1394', which is obviously a * mistake. One would hope that a non-1394 device never * gets connected to Firewire bus. If someone does, we * shouldn't be held responsible, so we'll allow it with a * warning. */ HPSB_WARN("Node " NODE_BUS_FMT " has invalid busID magic [0x%08x]", NODE_BUS_ARGS(host, nodeid), csr->bus_info_data[1]); } guid = ((u64)be32_to_cpu(csr->bus_info_data[3]) << 32) | be32_to_cpu(csr->bus_info_data[4]); ne = find_entry_by_guid(guid); if (ne && ne->host != host && ne->in_limbo) { /* Must have moved this device from one host to another */ nodemgr_remove_ne(ne); ne = NULL; } if (!ne) |
11305c3ed ieee1394: nodemgr... |
1314 |
nodemgr_create_node(guid, csr, host, nodeid, generation); |
1da177e4c Linux-2.6.12-rc2 |
1315 |
else |
11305c3ed ieee1394: nodemgr... |
1316 |
nodemgr_update_node(ne, csr, nodeid, generation); |
1da177e4c Linux-2.6.12-rc2 |
1317 |
} |
11305c3ed ieee1394: nodemgr... |
1318 |
static void nodemgr_node_scan(struct hpsb_host *host, int generation) |
1da177e4c Linux-2.6.12-rc2 |
1319 |
{ |
d41bba2d3 ieee1394: nodemgr... |
1320 |
int count; |
d41bba2d3 ieee1394: nodemgr... |
1321 1322 |
struct selfid *sid = (struct selfid *)host->topology_map; nodeid_t nodeid = LOCAL_BUS; |
1da177e4c Linux-2.6.12-rc2 |
1323 |
|
d41bba2d3 ieee1394: nodemgr... |
1324 1325 1326 1327 |
/* Scan each node on the bus */ for (count = host->selfid_count; count; count--, sid++) { if (sid->extended) continue; |
1da177e4c Linux-2.6.12-rc2 |
1328 |
|
d41bba2d3 ieee1394: nodemgr... |
1329 1330 1331 1332 |
if (!sid->link_active) { nodeid++; continue; } |
11305c3ed ieee1394: nodemgr... |
1333 |
nodemgr_node_scan_one(host, nodeid++, generation); |
d41bba2d3 ieee1394: nodemgr... |
1334 |
} |
1da177e4c Linux-2.6.12-rc2 |
1335 |
} |
11305c3ed ieee1394: nodemgr... |
1336 1337 |
static void nodemgr_pause_ne(struct node_entry *ne) { |
fc392fe83 ieee1394: survive... |
1338 |
HPSB_DEBUG("Node paused: ID:BUS[" NODE_BUS_FMT "] GUID[%016Lx]", |
11305c3ed ieee1394: nodemgr... |
1339 1340 |
NODE_BUS_ARGS(ne->host, ne->nodeid), (unsigned long long)ne->guid); |
fc392fe83 ieee1394: survive... |
1341 |
ne->in_limbo = true; |
11305c3ed ieee1394: nodemgr... |
1342 |
WARN_ON(device_create_file(&ne->device, &dev_attr_ne_in_limbo)); |
1da177e4c Linux-2.6.12-rc2 |
1343 |
} |
11305c3ed ieee1394: nodemgr... |
1344 |
static int update_pdrv(struct device *dev, void *data) |
1da177e4c Linux-2.6.12-rc2 |
1345 1346 |
{ struct unit_directory *ud; |
a0e857eef ieee1394: nodemgr... |
1347 |
struct device_driver *drv; |
1da177e4c Linux-2.6.12-rc2 |
1348 |
struct hpsb_protocol_driver *pdrv; |
11305c3ed ieee1394: nodemgr... |
1349 |
struct node_entry *ne = data; |
a0e857eef ieee1394: nodemgr... |
1350 |
int error; |
1da177e4c Linux-2.6.12-rc2 |
1351 |
|
73cf60232 ieee1394: use cla... |
1352 1353 |
ud = container_of(dev, struct unit_directory, unit_dev); if (ud->ne == ne) { |
a0e857eef ieee1394: nodemgr... |
1354 |
drv = get_driver(ud->device.driver); |
73cf60232 ieee1394: use cla... |
1355 1356 1357 1358 1359 |
if (drv) { error = 0; pdrv = container_of(drv, struct hpsb_protocol_driver, driver); if (pdrv->update) { |
8e9394ce2 Driver core: crea... |
1360 |
device_lock(&ud->device); |
73cf60232 ieee1394: use cla... |
1361 |
error = pdrv->update(ud); |
8e9394ce2 Driver core: crea... |
1362 |
device_unlock(&ud->device); |
73cf60232 ieee1394: use cla... |
1363 1364 1365 1366 |
} if (error) device_release_driver(&ud->device); put_driver(drv); |
1da177e4c Linux-2.6.12-rc2 |
1367 1368 |
} } |
73cf60232 ieee1394: use cla... |
1369 1370 1371 1372 1373 1374 |
return 0; } static void nodemgr_update_pdrv(struct node_entry *ne) { |
11305c3ed ieee1394: nodemgr... |
1375 |
class_for_each_device(&nodemgr_ud_class, NULL, ne, update_pdrv); |
1da177e4c Linux-2.6.12-rc2 |
1376 |
} |
61c7f775c ieee1394: write b... |
1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 |
/* Write the BROADCAST_CHANNEL as per IEEE1394a 8.3.2.3.11 and 8.4.2.3. This * seems like an optional service but in the end it is practically mandatory * as a consequence of these clauses. * * Note that we cannot do a broadcast write to all nodes at once because some * pre-1394a devices would hang. */ static void nodemgr_irm_write_bc(struct node_entry *ne, int generation) { const u64 bc_addr = (CSR_REGISTER_BASE | CSR_BROADCAST_CHANNEL); quadlet_t bc_remote, bc_local; |
7fdfc9094 ieee1394: nodemgr... |
1387 |
int error; |
61c7f775c ieee1394: write b... |
1388 1389 1390 1391 1392 1393 1394 1395 |
if (!ne->host->is_irm || ne->generation != generation || ne->nodeid == ne->host->node_id) return; bc_local = cpu_to_be32(ne->host->csr.broadcast_channel); /* Check if the register is implemented and 1394a compliant. */ |
7fdfc9094 ieee1394: nodemgr... |
1396 1397 1398 |
error = hpsb_read(ne->host, ne->nodeid, generation, bc_addr, &bc_remote, sizeof(bc_remote)); if (!error && bc_remote & cpu_to_be32(0x80000000) && |
61c7f775c ieee1394: write b... |
1399 1400 1401 |
bc_remote != bc_local) hpsb_node_write(ne, bc_addr, &bc_local, sizeof(bc_local)); } |
11305c3ed ieee1394: nodemgr... |
1402 1403 |
static void nodemgr_probe_ne(struct hpsb_host *host, struct node_entry *ne, int generation) |
1da177e4c Linux-2.6.12-rc2 |
1404 1405 |
{ struct device *dev; |
11305c3ed ieee1394: nodemgr... |
1406 |
if (ne->host != host || ne->in_limbo) |
1da177e4c Linux-2.6.12-rc2 |
1407 1408 1409 1410 1411 |
return; dev = get_device(&ne->device); if (!dev) return; |
61c7f775c ieee1394: write b... |
1412 |
nodemgr_irm_write_bc(ne, generation); |
1da177e4c Linux-2.6.12-rc2 |
1413 1414 1415 1416 1417 1418 |
/* If "needs_probe", then this is either a new or changed node we * rescan totally. If the generation matches for an existing node * (one that existed prior to the bus reset) we send update calls * down to the drivers. Otherwise, this is a dead node and we * suspend it. */ if (ne->needs_probe) |
11305c3ed ieee1394: nodemgr... |
1419 |
nodemgr_process_root_directory(ne); |
1da177e4c Linux-2.6.12-rc2 |
1420 1421 1422 |
else if (ne->generation == generation) nodemgr_update_pdrv(ne); else |
11305c3ed ieee1394: nodemgr... |
1423 |
nodemgr_pause_ne(ne); |
1da177e4c Linux-2.6.12-rc2 |
1424 1425 1426 |
put_device(dev); } |
11305c3ed ieee1394: nodemgr... |
1427 1428 |
struct node_probe_parameter { struct hpsb_host *host; |
73cf60232 ieee1394: use cla... |
1429 |
int generation; |
6848408ab ieee1394: regress... |
1430 |
bool probe_now; |
73cf60232 ieee1394: use cla... |
1431 |
}; |
6848408ab ieee1394: regress... |
1432 |
static int node_probe(struct device *dev, void *data) |
73cf60232 ieee1394: use cla... |
1433 |
{ |
11305c3ed ieee1394: nodemgr... |
1434 |
struct node_probe_parameter *p = data; |
73cf60232 ieee1394: use cla... |
1435 |
struct node_entry *ne; |
11305c3ed ieee1394: nodemgr... |
1436 |
if (p->generation != get_hpsb_generation(p->host)) |
c921a9745 ieee1394: don't d... |
1437 |
return -EAGAIN; |
73cf60232 ieee1394: use cla... |
1438 |
ne = container_of(dev, struct node_entry, node_dev); |
6848408ab ieee1394: regress... |
1439 |
if (ne->needs_probe == p->probe_now) |
11305c3ed ieee1394: nodemgr... |
1440 |
nodemgr_probe_ne(p->host, ne, p->generation); |
73cf60232 ieee1394: use cla... |
1441 1442 |
return 0; } |
1da177e4c Linux-2.6.12-rc2 |
1443 |
|
fc392fe83 ieee1394: survive... |
1444 |
static int nodemgr_node_probe(struct hpsb_host *host, int generation) |
1da177e4c Linux-2.6.12-rc2 |
1445 |
{ |
11305c3ed ieee1394: nodemgr... |
1446 |
struct node_probe_parameter p; |
1da177e4c Linux-2.6.12-rc2 |
1447 |
|
11305c3ed ieee1394: nodemgr... |
1448 |
p.host = host; |
6848408ab ieee1394: regress... |
1449 |
p.generation = generation; |
c921a9745 ieee1394: don't d... |
1450 1451 |
/* * Do some processing of the nodes we've probed. This pulls them |
1da177e4c Linux-2.6.12-rc2 |
1452 1453 |
* into the sysfs layer if needed, and can result in processing of * unit-directories, or just updating the node and it's |
51c1d80e9 ieee1394: run hig... |
1454 1455 1456 |
* unit-directories. * * Run updates before probes. Usually, updates are time-critical |
c921a9745 ieee1394: don't d... |
1457 1458 1459 1460 1461 1462 |
* while probes are time-consuming. * * Meanwhile, another bus reset may have happened. In this case we * skip everything here and let the next bus scan handle it. * Otherwise we may prematurely remove nodes which are still there. */ |
6848408ab ieee1394: regress... |
1463 |
p.probe_now = false; |
c921a9745 ieee1394: don't d... |
1464 |
if (class_for_each_device(&nodemgr_ne_class, NULL, &p, node_probe) != 0) |
fc392fe83 ieee1394: survive... |
1465 |
return 0; |
1da177e4c Linux-2.6.12-rc2 |
1466 |
|
c921a9745 ieee1394: don't d... |
1467 1468 |
p.probe_now = true; if (class_for_each_device(&nodemgr_ne_class, NULL, &p, node_probe) != 0) |
fc392fe83 ieee1394: survive... |
1469 |
return 0; |
c921a9745 ieee1394: don't d... |
1470 |
/* |
1da177e4c Linux-2.6.12-rc2 |
1471 1472 1473 1474 1475 1476 |
* Now let's tell the bus to rescan our devices. This may seem * like overhead, but the driver-model core will only scan a * device for a driver when either the device is added, or when a * new driver is added. A bus reset is a good reason to rescan * devices that were there before. For example, an sbp2 device * may become available for login, if the host that held it was |
c921a9745 ieee1394: don't d... |
1477 1478 1479 1480 |
* just removed. */ if (bus_rescan_devices(&ieee1394_bus_type) != 0) HPSB_DEBUG("bus_rescan_devices had an error"); |
fc392fe83 ieee1394: survive... |
1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 |
return 1; } static int remove_nodes_in_limbo(struct device *dev, void *data) { struct node_entry *ne; if (dev->bus != &ieee1394_bus_type) return 0; ne = container_of(dev, struct node_entry, device); if (ne->in_limbo) nodemgr_remove_ne(ne); return 0; } static void nodemgr_remove_nodes_in_limbo(struct hpsb_host *host) { device_for_each_child(&host->device, NULL, remove_nodes_in_limbo); |
1da177e4c Linux-2.6.12-rc2 |
1502 |
} |
14c0fa243 ieee1394: resume ... |
1503 1504 1505 |
static int nodemgr_send_resume_packet(struct hpsb_host *host) { struct hpsb_packet *packet; |
7fdfc9094 ieee1394: nodemgr... |
1506 |
int error = -ENOMEM; |
14c0fa243 ieee1394: resume ... |
1507 1508 |
packet = hpsb_make_phypacket(host, |
d7758461b ieee1394: add def... |
1509 1510 |
EXTPHYPACKET_TYPE_RESUME | NODEID_TO_NODE(host->node_id) << PHYPACKET_PORT_SHIFT); |
14c0fa243 ieee1394: resume ... |
1511 1512 1513 |
if (packet) { packet->no_waiter = 1; packet->generation = get_hpsb_generation(host); |
7fdfc9094 ieee1394: nodemgr... |
1514 |
error = hpsb_send_packet(packet); |
14c0fa243 ieee1394: resume ... |
1515 |
} |
7fdfc9094 ieee1394: nodemgr... |
1516 |
if (error) |
14c0fa243 ieee1394: resume ... |
1517 1518 |
HPSB_WARN("fw-host%d: Failed to broadcast resume packet", host->id); |
7fdfc9094 ieee1394: nodemgr... |
1519 |
return error; |
14c0fa243 ieee1394: resume ... |
1520 |
} |
61c7f775c ieee1394: write b... |
1521 |
/* Perform a few high-level IRM responsibilities. */ |
1da177e4c Linux-2.6.12-rc2 |
1522 1523 1524 1525 1526 1527 1528 |
static int nodemgr_do_irm_duties(struct hpsb_host *host, int cycles) { quadlet_t bc; /* if irm_id == -1 then there is no IRM on this bus */ if (!host->is_irm || host->irm_id == (nodeid_t)-1) return 1; |
61c7f775c ieee1394: write b... |
1529 1530 |
/* We are a 1394a-2000 compliant IRM. Set the validity bit. */ host->csr.broadcast_channel |= 0x40000000; |
1da177e4c Linux-2.6.12-rc2 |
1531 1532 1533 1534 1535 1536 1537 |
/* If there is no bus manager then we should set the root node's * force_root bit to promote bus stability per the 1394 * spec. (8.4.2.6) */ if (host->busmgr_id == 0xffff && host->node_count > 1) { u16 root_node = host->node_count - 1; |
1da177e4c Linux-2.6.12-rc2 |
1538 |
|
328699bf0 [PATCH] ieee1394:... |
1539 1540 1541 1542 1543 1544 |
/* get cycle master capability flag from root node */ if (host->is_cycmst || (!hpsb_read(host, LOCAL_BUS | root_node, get_hpsb_generation(host), (CSR_REGISTER_BASE + CSR_CONFIG_ROM + 2 * sizeof(quadlet_t)), &bc, sizeof(quadlet_t)) && be32_to_cpu(bc) & 1 << CSR_CMC_SHIFT)) |
1da177e4c Linux-2.6.12-rc2 |
1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 |
hpsb_send_phy_config(host, root_node, -1); else { HPSB_DEBUG("The root node is not cycle master capable; " "selecting a new root node and resetting..."); if (cycles >= 5) { /* Oh screw it! Just leave the bus as it is */ HPSB_DEBUG("Stopping reset loop for IRM sanity"); return 1; } hpsb_send_phy_config(host, NODEID_TO_NODE(host->node_id), -1); hpsb_reset_bus(host, LONG_RESET_FORCE_ROOT); return 0; } } |
14c0fa243 ieee1394: resume ... |
1562 1563 1564 1565 1566 1567 |
/* Some devices suspend their ports while being connected to an inactive * host adapter, i.e. if connected before the low-level driver is * loaded. They become visible either when physically unplugged and * replugged, or when receiving a resume packet. Send one once. */ if (!host->resume_packet_sent && !nodemgr_send_resume_packet(host)) host->resume_packet_sent = 1; |
1da177e4c Linux-2.6.12-rc2 |
1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 |
return 1; } /* We need to ensure that if we are not the IRM, that the IRM node is capable of * everything we can do, otherwise issue a bus reset and try to become the IRM * ourselves. */ static int nodemgr_check_irm_capability(struct hpsb_host *host, int cycles) { quadlet_t bc; int status; if (hpsb_disable_irm || host->is_irm) return 1; status = hpsb_read(host, LOCAL_BUS | (host->irm_id), get_hpsb_generation(host), (CSR_REGISTER_BASE | CSR_BROADCAST_CHANNEL), &bc, sizeof(quadlet_t)); if (status < 0 || !(be32_to_cpu(bc) & 0x80000000)) { /* The current irm node does not have a valid BROADCAST_CHANNEL * register and we do, so reset the bus with force_root set */ HPSB_DEBUG("Current remote IRM is not 1394a-2000 compliant, resetting..."); if (cycles >= 5) { /* Oh screw it! Just leave the bus as it is */ HPSB_DEBUG("Stopping reset loop for IRM sanity"); return 1; } hpsb_send_phy_config(host, NODEID_TO_NODE(host->node_id), -1); hpsb_reset_bus(host, LONG_RESET_FORCE_ROOT); return 0; } return 1; } |
11305c3ed ieee1394: nodemgr... |
1606 |
static int nodemgr_host_thread(void *data) |
1da177e4c Linux-2.6.12-rc2 |
1607 |
{ |
11305c3ed ieee1394: nodemgr... |
1608 |
struct hpsb_host *host = data; |
b7a7179dc ieee1394: nodemgr... |
1609 |
unsigned int g, generation = 0; |
d2f119fe3 [PATCH] ieee1394:... |
1610 |
int i, reset_cycles = 0; |
1da177e4c Linux-2.6.12-rc2 |
1611 |
|
831441862 Freezer: make ker... |
1612 |
set_freezable(); |
1da177e4c Linux-2.6.12-rc2 |
1613 1614 |
/* Setup our device-model entries */ nodemgr_create_host_dev_files(host); |
d2f119fe3 [PATCH] ieee1394:... |
1615 1616 1617 |
for (;;) { /* Sleep until next bus reset */ set_current_state(TASK_INTERRUPTIBLE); |
a65421ea3 ieee1394: fix ano... |
1618 1619 |
if (get_hpsb_generation(host) == generation && !kthread_should_stop()) |
d2f119fe3 [PATCH] ieee1394:... |
1620 1621 1622 1623 1624 1625 1626 1627 |
schedule(); __set_current_state(TASK_RUNNING); /* Thread may have been woken up to freeze or to exit */ if (try_to_freeze()) continue; if (kthread_should_stop()) goto exit; |
1da177e4c Linux-2.6.12-rc2 |
1628 |
|
1da177e4c Linux-2.6.12-rc2 |
1629 1630 |
/* Pause for 1/4 second in 1/16 second intervals, * to make sure things settle down. */ |
d2f119fe3 [PATCH] ieee1394:... |
1631 |
g = get_hpsb_generation(host); |
1da177e4c Linux-2.6.12-rc2 |
1632 |
for (i = 0; i < 4 ; i++) { |
69e2b6029 ieee1394: Fix kth... |
1633 |
msleep_interruptible(63); |
ec9a13cdb ieee1394: node ma... |
1634 |
try_to_freeze(); |
69e2b6029 ieee1394: Fix kth... |
1635 |
if (kthread_should_stop()) |
a0e857eef ieee1394: nodemgr... |
1636 |
goto exit; |
1da177e4c Linux-2.6.12-rc2 |
1637 1638 1639 1640 1641 1642 1643 1644 1645 |
/* Now get the generation in which the node ID's we collect * are valid. During the bus scan we will use this generation * for the read transactions, so that if another reset occurs * during the scan the transactions will fail instead of * returning bogus data. */ generation = get_hpsb_generation(host); /* If we get a reset before we are done waiting, then |
59c51591a Fix occurrences o... |
1646 |
* start the waiting over again */ |
d2f119fe3 [PATCH] ieee1394:... |
1647 1648 |
if (generation != g) g = generation, i = 0; |
1da177e4c Linux-2.6.12-rc2 |
1649 |
} |
328699bf0 [PATCH] ieee1394:... |
1650 1651 |
if (!nodemgr_check_irm_capability(host, reset_cycles) || !nodemgr_do_irm_duties(host, reset_cycles)) { |
1da177e4c Linux-2.6.12-rc2 |
1652 |
reset_cycles++; |
1da177e4c Linux-2.6.12-rc2 |
1653 1654 |
continue; } |
328699bf0 [PATCH] ieee1394:... |
1655 |
reset_cycles = 0; |
1da177e4c Linux-2.6.12-rc2 |
1656 1657 1658 |
/* Scan our nodes to get the bus options and create node * entries. This does not do the sysfs stuff, since that |
312c004d3 [PATCH] driver co... |
1659 1660 |
* would trigger uevents and such, which is a bad idea at * this point. */ |
11305c3ed ieee1394: nodemgr... |
1661 |
nodemgr_node_scan(host, generation); |
1da177e4c Linux-2.6.12-rc2 |
1662 1663 1664 |
/* This actually does the full probe, with sysfs * registration. */ |
fc392fe83 ieee1394: survive... |
1665 1666 |
if (!nodemgr_node_probe(host, generation)) continue; |
1da177e4c Linux-2.6.12-rc2 |
1667 1668 1669 |
/* Update some of our sysfs symlinks */ nodemgr_update_host_dev_links(host); |
fc392fe83 ieee1394: survive... |
1670 1671 1672 1673 |
/* Sleep 3 seconds */ for (i = 3000/200; i; i--) { msleep_interruptible(200); |
ec9a13cdb ieee1394: node ma... |
1674 |
try_to_freeze(); |
fc392fe83 ieee1394: survive... |
1675 1676 1677 1678 1679 1680 1681 1682 1683 |
if (kthread_should_stop()) goto exit; if (generation != get_hpsb_generation(host)) break; } /* Remove nodes which are gone, unless a bus reset happened */ if (!i) nodemgr_remove_nodes_in_limbo(host); |
1da177e4c Linux-2.6.12-rc2 |
1684 |
} |
d2f119fe3 [PATCH] ieee1394:... |
1685 |
exit: |
1da177e4c Linux-2.6.12-rc2 |
1686 |
HPSB_VERBOSE("NodeMgr: Exiting thread"); |
d2f119fe3 [PATCH] ieee1394:... |
1687 |
return 0; |
1da177e4c Linux-2.6.12-rc2 |
1688 |
} |
11305c3ed ieee1394: nodemgr... |
1689 |
struct per_host_parameter { |
73cf60232 ieee1394: use cla... |
1690 1691 1692 |
void *data; int (*cb)(struct hpsb_host *, void *); }; |
11305c3ed ieee1394: nodemgr... |
1693 |
static int per_host(struct device *dev, void *data) |
73cf60232 ieee1394: use cla... |
1694 1695 |
{ struct hpsb_host *host; |
11305c3ed ieee1394: nodemgr... |
1696 |
struct per_host_parameter *p = data; |
73cf60232 ieee1394: use cla... |
1697 1698 |
host = container_of(dev, struct hpsb_host, host_dev); |
11305c3ed ieee1394: nodemgr... |
1699 |
return p->cb(host, p->data); |
73cf60232 ieee1394: use cla... |
1700 |
} |
11305c3ed ieee1394: nodemgr... |
1701 |
|
afd6546d8 ieee1394: move so... |
1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 |
/** * nodemgr_for_each_host - call a function for each IEEE 1394 host * @data: an address to supply to the callback * @cb: function to call for each host * * Iterate the hosts, calling a given function with supplied data for each host. * If the callback fails on a host, i.e. if it returns a non-zero value, the * iteration is stopped. * * Return value: 0 on success, non-zero on failure (same as returned by last run * of the callback). */ int nodemgr_for_each_host(void *data, int (*cb)(struct hpsb_host *, void *)) |
1da177e4c Linux-2.6.12-rc2 |
1715 |
{ |
11305c3ed ieee1394: nodemgr... |
1716 |
struct per_host_parameter p; |
1da177e4c Linux-2.6.12-rc2 |
1717 |
|
11305c3ed ieee1394: nodemgr... |
1718 1719 1720 |
p.cb = cb; p.data = data; return class_for_each_device(&hpsb_host_class, NULL, &p, per_host); |
1da177e4c Linux-2.6.12-rc2 |
1721 |
} |
ef8153348 ieee1394: remove ... |
1722 |
/* The following two convenience functions use a struct node_entry |
1da177e4c Linux-2.6.12-rc2 |
1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 |
* for addressing a node on the bus. They are intended for use by any * process context, not just the nodemgr thread, so we need to be a * little careful when reading out the node ID and generation. The * thing that can go wrong is that we get the node ID, then a bus * reset occurs, and then we read the generation. The node ID is * possibly invalid, but the generation is current, and we end up * sending a packet to a the wrong node. * * The solution is to make sure we read the generation first, so that * if a reset occurs in the process, we end up with a stale generation * and the transactions will fail instead of silently using wrong node * ID's. */ |
afd6546d8 ieee1394: move so... |
1736 1737 1738 1739 1740 1741 1742 1743 1744 |
/** * hpsb_node_fill_packet - fill some destination information into a packet * @ne: destination node * @packet: packet to fill in * * This will fill in the given, pre-initialised hpsb_packet with the current * information from the node entry (host, node ID, bus generation number). */ void hpsb_node_fill_packet(struct node_entry *ne, struct hpsb_packet *packet) |
1da177e4c Linux-2.6.12-rc2 |
1745 |
{ |
afd6546d8 ieee1394: move so... |
1746 1747 |
packet->host = ne->host; packet->generation = ne->generation; |
29f8ea8ab ieee1394: use cor... |
1748 |
smp_rmb(); |
afd6546d8 ieee1394: move so... |
1749 |
packet->node_id = ne->nodeid; |
1da177e4c Linux-2.6.12-rc2 |
1750 1751 1752 1753 1754 1755 |
} int hpsb_node_write(struct node_entry *ne, u64 addr, quadlet_t *buffer, size_t length) { unsigned int generation = ne->generation; |
29f8ea8ab ieee1394: use cor... |
1756 |
smp_rmb(); |
1da177e4c Linux-2.6.12-rc2 |
1757 1758 1759 1760 1761 1762 1763 1764 1765 |
return hpsb_write(ne->host, ne->nodeid, generation, addr, buffer, length); } static void nodemgr_add_host(struct hpsb_host *host) { struct host_info *hi; hi = hpsb_create_hostinfo(&nodemgr_highlevel, host, sizeof(*hi)); |
1da177e4c Linux-2.6.12-rc2 |
1766 |
if (!hi) { |
d2f119fe3 [PATCH] ieee1394:... |
1767 |
HPSB_ERR("NodeMgr: out of memory in add host"); |
1da177e4c Linux-2.6.12-rc2 |
1768 1769 |
return; } |
1da177e4c Linux-2.6.12-rc2 |
1770 |
hi->host = host; |
11305c3ed ieee1394: nodemgr... |
1771 |
hi->thread = kthread_run(nodemgr_host_thread, host, "knodemgrd_%d", |
d2f119fe3 [PATCH] ieee1394:... |
1772 1773 1774 |
host->id); if (IS_ERR(hi->thread)) { HPSB_ERR("NodeMgr: cannot start thread for host %d", host->id); |
1da177e4c Linux-2.6.12-rc2 |
1775 |
hpsb_destroy_hostinfo(&nodemgr_highlevel, host); |
1da177e4c Linux-2.6.12-rc2 |
1776 |
} |
1da177e4c Linux-2.6.12-rc2 |
1777 1778 1779 1780 1781 |
} static void nodemgr_host_reset(struct hpsb_host *host) { struct host_info *hi = hpsb_get_hostinfo(&nodemgr_highlevel, host); |
d2f119fe3 [PATCH] ieee1394:... |
1782 1783 1784 1785 |
if (hi) { HPSB_VERBOSE("NodeMgr: Processing reset for host %d", host->id); wake_up_process(hi->thread); } |
1da177e4c Linux-2.6.12-rc2 |
1786 1787 1788 1789 1790 1791 1792 |
} static void nodemgr_remove_host(struct hpsb_host *host) { struct host_info *hi = hpsb_get_hostinfo(&nodemgr_highlevel, host); if (hi) { |
d2f119fe3 [PATCH] ieee1394:... |
1793 1794 1795 |
kthread_stop(hi->thread); nodemgr_remove_host_dev(&host->device); } |
1da177e4c Linux-2.6.12-rc2 |
1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 |
} static struct hpsb_highlevel nodemgr_highlevel = { .name = "Node manager", .add_host = nodemgr_add_host, .host_reset = nodemgr_host_reset, .remove_host = nodemgr_remove_host, }; int init_ieee1394_nodemgr(void) { |
7fdfc9094 ieee1394: nodemgr... |
1807 |
int error; |
1da177e4c Linux-2.6.12-rc2 |
1808 |
|
7fdfc9094 ieee1394: nodemgr... |
1809 1810 |
error = class_register(&nodemgr_ne_class); if (error) |
91efa4620 ieee1394: fix hos... |
1811 |
goto fail_ne; |
7fdfc9094 ieee1394: nodemgr... |
1812 |
error = class_register(&nodemgr_ud_class); |
91efa4620 ieee1394: fix hos... |
1813 1814 |
if (error) goto fail_ud; |
8252bbb13 ieee1394: nodemgr... |
1815 |
error = driver_register(&nodemgr_mid_layer_driver); |
91efa4620 ieee1394: fix hos... |
1816 1817 1818 1819 |
if (error) goto fail_ml; /* This driver is not used if nodemgr is off (disable_nodemgr=1). */ nodemgr_dev_template_host.driver = &nodemgr_mid_layer_driver; |
1da177e4c Linux-2.6.12-rc2 |
1820 |
hpsb_register_highlevel(&nodemgr_highlevel); |
1da177e4c Linux-2.6.12-rc2 |
1821 |
return 0; |
91efa4620 ieee1394: fix hos... |
1822 1823 1824 1825 1826 1827 1828 |
fail_ml: class_unregister(&nodemgr_ud_class); fail_ud: class_unregister(&nodemgr_ne_class); fail_ne: return error; |
1da177e4c Linux-2.6.12-rc2 |
1829 1830 1831 1832 |
} void cleanup_ieee1394_nodemgr(void) { |
d41bba2d3 ieee1394: nodemgr... |
1833 |
hpsb_unregister_highlevel(&nodemgr_highlevel); |
91efa4620 ieee1394: fix hos... |
1834 |
driver_unregister(&nodemgr_mid_layer_driver); |
1da177e4c Linux-2.6.12-rc2 |
1835 1836 1837 |
class_unregister(&nodemgr_ud_class); class_unregister(&nodemgr_ne_class); } |