Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 1 | /* |
| 2 | * Incremental bus scan, based on bus topology |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 3 | * |
| 4 | * Copyright (C) 2004-2006 Kristian Hoegsberg <krh@bitplanet.net> |
| 5 | * |
| 6 | * This program is free software; you can redistribute it and/or modify |
| 7 | * it under the terms of the GNU General Public License as published by |
| 8 | * the Free Software Foundation; either version 2 of the License, or |
| 9 | * (at your option) any later version. |
| 10 | * |
| 11 | * This program is distributed in the hope that it will be useful, |
| 12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 14 | * GNU General Public License for more details. |
| 15 | * |
| 16 | * You should have received a copy of the GNU General Public License |
| 17 | * along with this program; if not, write to the Free Software Foundation, |
| 18 | * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. |
| 19 | */ |
| 20 | |
| 21 | #include <linux/module.h> |
| 22 | #include <linux/wait.h> |
| 23 | #include <linux/errno.h> |
Stefan Richter | a2cdebe | 2008-03-08 22:38:16 +0100 | [diff] [blame] | 24 | #include <asm/bug.h> |
Stefan Richter | b5d2a5e | 2008-01-25 18:57:41 +0100 | [diff] [blame] | 25 | #include <asm/system.h> |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 26 | #include "fw-transaction.h" |
| 27 | #include "fw-topology.h" |
| 28 | |
Kristian Høgsberg | a77754a | 2007-05-07 20:33:35 -0400 | [diff] [blame] | 29 | #define SELF_ID_PHY_ID(q) (((q) >> 24) & 0x3f) |
| 30 | #define SELF_ID_EXTENDED(q) (((q) >> 23) & 0x01) |
| 31 | #define SELF_ID_LINK_ON(q) (((q) >> 22) & 0x01) |
| 32 | #define SELF_ID_GAP_COUNT(q) (((q) >> 16) & 0x3f) |
| 33 | #define SELF_ID_PHY_SPEED(q) (((q) >> 14) & 0x03) |
| 34 | #define SELF_ID_CONTENDER(q) (((q) >> 11) & 0x01) |
| 35 | #define SELF_ID_PHY_INITIATOR(q) (((q) >> 1) & 0x01) |
| 36 | #define SELF_ID_MORE_PACKETS(q) (((q) >> 0) & 0x01) |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 37 | |
Kristian Høgsberg | a77754a | 2007-05-07 20:33:35 -0400 | [diff] [blame] | 38 | #define SELF_ID_EXT_SEQUENCE(q) (((q) >> 20) & 0x07) |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 39 | |
| 40 | static u32 *count_ports(u32 *sid, int *total_port_count, int *child_port_count) |
| 41 | { |
| 42 | u32 q; |
| 43 | int port_type, shift, seq; |
| 44 | |
| 45 | *total_port_count = 0; |
| 46 | *child_port_count = 0; |
| 47 | |
| 48 | shift = 6; |
| 49 | q = *sid; |
| 50 | seq = 0; |
| 51 | |
| 52 | while (1) { |
| 53 | port_type = (q >> shift) & 0x03; |
| 54 | switch (port_type) { |
| 55 | case SELFID_PORT_CHILD: |
| 56 | (*child_port_count)++; |
| 57 | case SELFID_PORT_PARENT: |
| 58 | case SELFID_PORT_NCONN: |
| 59 | (*total_port_count)++; |
| 60 | case SELFID_PORT_NONE: |
| 61 | break; |
| 62 | } |
| 63 | |
| 64 | shift -= 2; |
| 65 | if (shift == 0) { |
Kristian Høgsberg | a77754a | 2007-05-07 20:33:35 -0400 | [diff] [blame] | 66 | if (!SELF_ID_MORE_PACKETS(q)) |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 67 | return sid + 1; |
| 68 | |
| 69 | shift = 16; |
| 70 | sid++; |
| 71 | q = *sid; |
| 72 | |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 73 | /* |
| 74 | * Check that the extra packets actually are |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 75 | * extended self ID packets and that the |
| 76 | * sequence numbers in the extended self ID |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 77 | * packets increase as expected. |
| 78 | */ |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 79 | |
Kristian Høgsberg | a77754a | 2007-05-07 20:33:35 -0400 | [diff] [blame] | 80 | if (!SELF_ID_EXTENDED(q) || |
| 81 | seq != SELF_ID_EXT_SEQUENCE(q)) |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 82 | return NULL; |
| 83 | |
| 84 | seq++; |
| 85 | } |
| 86 | } |
| 87 | } |
| 88 | |
| 89 | static int get_port_type(u32 *sid, int port_index) |
| 90 | { |
| 91 | int index, shift; |
| 92 | |
| 93 | index = (port_index + 5) / 8; |
| 94 | shift = 16 - ((port_index + 5) & 7) * 2; |
| 95 | return (sid[index] >> shift) & 0x03; |
| 96 | } |
| 97 | |
Adrian Bunk | 95688e9 | 2007-01-22 19:17:37 +0100 | [diff] [blame] | 98 | static struct fw_node *fw_node_create(u32 sid, int port_count, int color) |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 99 | { |
| 100 | struct fw_node *node; |
| 101 | |
Kristian Høgsberg | 2d826cc | 2007-05-09 19:23:14 -0400 | [diff] [blame] | 102 | node = kzalloc(sizeof(*node) + port_count * sizeof(node->ports[0]), |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 103 | GFP_ATOMIC); |
| 104 | if (node == NULL) |
| 105 | return NULL; |
| 106 | |
| 107 | node->color = color; |
Kristian Høgsberg | a77754a | 2007-05-07 20:33:35 -0400 | [diff] [blame] | 108 | node->node_id = LOCAL_BUS | SELF_ID_PHY_ID(sid); |
| 109 | node->link_on = SELF_ID_LINK_ON(sid); |
| 110 | node->phy_speed = SELF_ID_PHY_SPEED(sid); |
Stefan Richter | c9755e1 | 2008-03-24 20:54:28 +0100 | [diff] [blame] | 111 | node->initiated_reset = SELF_ID_PHY_INITIATOR(sid); |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 112 | node->port_count = port_count; |
| 113 | |
| 114 | atomic_set(&node->ref_count, 1); |
| 115 | INIT_LIST_HEAD(&node->link); |
| 116 | |
| 117 | return node; |
| 118 | } |
| 119 | |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 120 | /* |
| 121 | * Compute the maximum hop count for this node and it's children. The |
Kristian Høgsberg | 83db801 | 2007-01-26 00:37:50 -0500 | [diff] [blame] | 122 | * maximum hop count is the maximum number of connections between any |
| 123 | * two nodes in the subtree rooted at this node. We need this for |
| 124 | * setting the gap count. As we build the tree bottom up in |
| 125 | * build_tree() below, this is fairly easy to do: for each node we |
| 126 | * maintain the max hop count and the max depth, ie the number of hops |
| 127 | * to the furthest leaf. Computing the max hop count breaks down into |
| 128 | * two cases: either the path goes through this node, in which case |
| 129 | * the hop count is the sum of the two biggest child depths plus 2. |
| 130 | * Or it could be the case that the max hop path is entirely |
| 131 | * containted in a child tree, in which case the max hop count is just |
| 132 | * the max hop count of this child. |
| 133 | */ |
| 134 | static void update_hop_count(struct fw_node *node) |
| 135 | { |
| 136 | int depths[2] = { -1, -1 }; |
| 137 | int max_child_hops = 0; |
| 138 | int i; |
| 139 | |
| 140 | for (i = 0; i < node->port_count; i++) { |
Stefan Richter | dae1a3a | 2007-06-17 23:39:58 +0200 | [diff] [blame] | 141 | if (node->ports[i] == NULL) |
Kristian Høgsberg | 83db801 | 2007-01-26 00:37:50 -0500 | [diff] [blame] | 142 | continue; |
| 143 | |
Stefan Richter | dae1a3a | 2007-06-17 23:39:58 +0200 | [diff] [blame] | 144 | if (node->ports[i]->max_hops > max_child_hops) |
| 145 | max_child_hops = node->ports[i]->max_hops; |
Kristian Høgsberg | 83db801 | 2007-01-26 00:37:50 -0500 | [diff] [blame] | 146 | |
Stefan Richter | dae1a3a | 2007-06-17 23:39:58 +0200 | [diff] [blame] | 147 | if (node->ports[i]->max_depth > depths[0]) { |
Kristian Høgsberg | 83db801 | 2007-01-26 00:37:50 -0500 | [diff] [blame] | 148 | depths[1] = depths[0]; |
Stefan Richter | dae1a3a | 2007-06-17 23:39:58 +0200 | [diff] [blame] | 149 | depths[0] = node->ports[i]->max_depth; |
| 150 | } else if (node->ports[i]->max_depth > depths[1]) |
| 151 | depths[1] = node->ports[i]->max_depth; |
Kristian Høgsberg | 83db801 | 2007-01-26 00:37:50 -0500 | [diff] [blame] | 152 | } |
| 153 | |
| 154 | node->max_depth = depths[0] + 1; |
| 155 | node->max_hops = max(max_child_hops, depths[0] + depths[1] + 2); |
| 156 | } |
| 157 | |
Stefan Richter | e5f84f8 | 2007-10-07 02:10:11 +0200 | [diff] [blame] | 158 | static inline struct fw_node *fw_node(struct list_head *l) |
| 159 | { |
| 160 | return list_entry(l, struct fw_node, link); |
| 161 | } |
Kristian Høgsberg | 83db801 | 2007-01-26 00:37:50 -0500 | [diff] [blame] | 162 | |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 163 | /** |
| 164 | * build_tree - Build the tree representation of the topology |
| 165 | * @self_ids: array of self IDs to create the tree from |
| 166 | * @self_id_count: the length of the self_ids array |
| 167 | * @local_id: the node ID of the local node |
| 168 | * |
| 169 | * This function builds the tree representation of the topology given |
| 170 | * by the self IDs from the latest bus reset. During the construction |
| 171 | * of the tree, the function checks that the self IDs are valid and |
Yann Dirson | c1b91ce | 2007-10-07 02:21:29 +0200 | [diff] [blame] | 172 | * internally consistent. On succcess this function returns the |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 173 | * fw_node corresponding to the local card otherwise NULL. |
| 174 | */ |
Kristian Høgsberg | 473d28c | 2007-03-07 12:12:55 -0500 | [diff] [blame] | 175 | static struct fw_node *build_tree(struct fw_card *card, |
| 176 | u32 *sid, int self_id_count) |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 177 | { |
Kristian Høgsberg | 93e4fd4 | 2007-03-27 09:42:39 -0500 | [diff] [blame] | 178 | struct fw_node *node, *child, *local_node, *irm_node; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 179 | struct list_head stack, *h; |
Kristian Høgsberg | 473d28c | 2007-03-07 12:12:55 -0500 | [diff] [blame] | 180 | u32 *next_sid, *end, q; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 181 | int i, port_count, child_port_count, phy_id, parent_count, stack_depth; |
Stefan Richter | 24d4012 | 2007-06-18 19:44:12 +0200 | [diff] [blame] | 182 | int gap_count; |
| 183 | bool beta_repeaters_present; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 184 | |
| 185 | local_node = NULL; |
| 186 | node = NULL; |
| 187 | INIT_LIST_HEAD(&stack); |
| 188 | stack_depth = 0; |
Kristian Høgsberg | 473d28c | 2007-03-07 12:12:55 -0500 | [diff] [blame] | 189 | end = sid + self_id_count; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 190 | phy_id = 0; |
Kristian Høgsberg | 93e4fd4 | 2007-03-27 09:42:39 -0500 | [diff] [blame] | 191 | irm_node = NULL; |
Kristian Høgsberg | a77754a | 2007-05-07 20:33:35 -0400 | [diff] [blame] | 192 | gap_count = SELF_ID_GAP_COUNT(*sid); |
Stefan Richter | 24d4012 | 2007-06-18 19:44:12 +0200 | [diff] [blame] | 193 | beta_repeaters_present = false; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 194 | |
| 195 | while (sid < end) { |
| 196 | next_sid = count_ports(sid, &port_count, &child_port_count); |
| 197 | |
| 198 | if (next_sid == NULL) { |
| 199 | fw_error("Inconsistent extended self IDs.\n"); |
| 200 | return NULL; |
| 201 | } |
| 202 | |
| 203 | q = *sid; |
Kristian Høgsberg | a77754a | 2007-05-07 20:33:35 -0400 | [diff] [blame] | 204 | if (phy_id != SELF_ID_PHY_ID(q)) { |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 205 | fw_error("PHY ID mismatch in self ID: %d != %d.\n", |
Kristian Høgsberg | a77754a | 2007-05-07 20:33:35 -0400 | [diff] [blame] | 206 | phy_id, SELF_ID_PHY_ID(q)); |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 207 | return NULL; |
| 208 | } |
| 209 | |
| 210 | if (child_port_count > stack_depth) { |
| 211 | fw_error("Topology stack underflow\n"); |
| 212 | return NULL; |
| 213 | } |
| 214 | |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 215 | /* |
| 216 | * Seek back from the top of our stack to find the |
| 217 | * start of the child nodes for this node. |
| 218 | */ |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 219 | for (i = 0, h = &stack; i < child_port_count; i++) |
| 220 | h = h->prev; |
Yann Dirson | c1b91ce | 2007-10-07 02:21:29 +0200 | [diff] [blame] | 221 | /* |
| 222 | * When the stack is empty, this yields an invalid value, |
| 223 | * but that pointer will never be dereferenced. |
| 224 | */ |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 225 | child = fw_node(h); |
| 226 | |
| 227 | node = fw_node_create(q, port_count, card->color); |
| 228 | if (node == NULL) { |
Stefan Richter | 8a8cea2 | 2007-06-09 19:26:22 +0200 | [diff] [blame] | 229 | fw_error("Out of memory while building topology.\n"); |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 230 | return NULL; |
| 231 | } |
| 232 | |
| 233 | if (phy_id == (card->node_id & 0x3f)) |
| 234 | local_node = node; |
| 235 | |
Kristian Høgsberg | a77754a | 2007-05-07 20:33:35 -0400 | [diff] [blame] | 236 | if (SELF_ID_CONTENDER(q)) |
Kristian Høgsberg | 93e4fd4 | 2007-03-27 09:42:39 -0500 | [diff] [blame] | 237 | irm_node = node; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 238 | |
| 239 | parent_count = 0; |
| 240 | |
| 241 | for (i = 0; i < port_count; i++) { |
| 242 | switch (get_port_type(sid, i)) { |
| 243 | case SELFID_PORT_PARENT: |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 244 | /* |
| 245 | * Who's your daddy? We dont know the |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 246 | * parent node at this time, so we |
| 247 | * temporarily abuse node->color for |
| 248 | * remembering the entry in the |
| 249 | * node->ports array where the parent |
| 250 | * node should be. Later, when we |
| 251 | * handle the parent node, we fix up |
| 252 | * the reference. |
| 253 | */ |
| 254 | parent_count++; |
| 255 | node->color = i; |
| 256 | break; |
| 257 | |
| 258 | case SELFID_PORT_CHILD: |
Stefan Richter | dae1a3a | 2007-06-17 23:39:58 +0200 | [diff] [blame] | 259 | node->ports[i] = child; |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 260 | /* |
| 261 | * Fix up parent reference for this |
| 262 | * child node. |
| 263 | */ |
Stefan Richter | dae1a3a | 2007-06-17 23:39:58 +0200 | [diff] [blame] | 264 | child->ports[child->color] = node; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 265 | child->color = card->color; |
| 266 | child = fw_node(child->link.next); |
| 267 | break; |
| 268 | } |
| 269 | } |
| 270 | |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 271 | /* |
| 272 | * Check that the node reports exactly one parent |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 273 | * port, except for the root, which of course should |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 274 | * have no parents. |
| 275 | */ |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 276 | if ((next_sid == end && parent_count != 0) || |
| 277 | (next_sid < end && parent_count != 1)) { |
| 278 | fw_error("Parent port inconsistency for node %d: " |
| 279 | "parent_count=%d\n", phy_id, parent_count); |
| 280 | return NULL; |
| 281 | } |
| 282 | |
| 283 | /* Pop the child nodes off the stack and push the new node. */ |
| 284 | __list_del(h->prev, &stack); |
| 285 | list_add_tail(&node->link, &stack); |
| 286 | stack_depth += 1 - child_port_count; |
| 287 | |
Stefan Richter | 24d4012 | 2007-06-18 19:44:12 +0200 | [diff] [blame] | 288 | if (node->phy_speed == SCODE_BETA && |
| 289 | parent_count + child_port_count > 1) |
| 290 | beta_repeaters_present = true; |
| 291 | |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 292 | /* |
Stefan Richter | 25b1c3d | 2008-03-24 20:57:12 +0100 | [diff] [blame] | 293 | * If PHYs report different gap counts, set an invalid count |
| 294 | * which will force a gap count reconfiguration and a reset. |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 295 | */ |
Kristian Høgsberg | a77754a | 2007-05-07 20:33:35 -0400 | [diff] [blame] | 296 | if (SELF_ID_GAP_COUNT(q) != gap_count) |
Stefan Richter | 25b1c3d | 2008-03-24 20:57:12 +0100 | [diff] [blame] | 297 | gap_count = 0; |
Kristian Høgsberg | 83db801 | 2007-01-26 00:37:50 -0500 | [diff] [blame] | 298 | |
| 299 | update_hop_count(node); |
| 300 | |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 301 | sid = next_sid; |
| 302 | phy_id++; |
| 303 | } |
| 304 | |
| 305 | card->root_node = node; |
Kristian Høgsberg | 93e4fd4 | 2007-03-27 09:42:39 -0500 | [diff] [blame] | 306 | card->irm_node = irm_node; |
Kristian Høgsberg | 83db801 | 2007-01-26 00:37:50 -0500 | [diff] [blame] | 307 | card->gap_count = gap_count; |
Stefan Richter | 24d4012 | 2007-06-18 19:44:12 +0200 | [diff] [blame] | 308 | card->beta_repeaters_present = beta_repeaters_present; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 309 | |
| 310 | return local_node; |
| 311 | } |
| 312 | |
Kristian Høgsberg | a98e271 | 2007-05-07 20:33:34 -0400 | [diff] [blame] | 313 | typedef void (*fw_node_callback_t)(struct fw_card * card, |
| 314 | struct fw_node * node, |
| 315 | struct fw_node * parent); |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 316 | |
| 317 | static void |
| 318 | for_each_fw_node(struct fw_card *card, struct fw_node *root, |
| 319 | fw_node_callback_t callback) |
| 320 | { |
| 321 | struct list_head list; |
| 322 | struct fw_node *node, *next, *child, *parent; |
| 323 | int i; |
| 324 | |
| 325 | INIT_LIST_HEAD(&list); |
| 326 | |
| 327 | fw_node_get(root); |
| 328 | list_add_tail(&root->link, &list); |
| 329 | parent = NULL; |
| 330 | list_for_each_entry(node, &list, link) { |
| 331 | node->color = card->color; |
| 332 | |
| 333 | for (i = 0; i < node->port_count; i++) { |
Stefan Richter | dae1a3a | 2007-06-17 23:39:58 +0200 | [diff] [blame] | 334 | child = node->ports[i]; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 335 | if (!child) |
| 336 | continue; |
| 337 | if (child->color == card->color) |
| 338 | parent = child; |
| 339 | else { |
| 340 | fw_node_get(child); |
| 341 | list_add_tail(&child->link, &list); |
| 342 | } |
| 343 | } |
| 344 | |
| 345 | callback(card, node, parent); |
| 346 | } |
| 347 | |
| 348 | list_for_each_entry_safe(node, next, &list, link) |
| 349 | fw_node_put(node); |
| 350 | } |
| 351 | |
| 352 | static void |
| 353 | report_lost_node(struct fw_card *card, |
| 354 | struct fw_node *node, struct fw_node *parent) |
| 355 | { |
| 356 | fw_node_event(card, node, FW_NODE_DESTROYED); |
| 357 | fw_node_put(node); |
| 358 | } |
| 359 | |
| 360 | static void |
| 361 | report_found_node(struct fw_card *card, |
| 362 | struct fw_node *node, struct fw_node *parent) |
| 363 | { |
| 364 | int b_path = (node->phy_speed == SCODE_BETA); |
| 365 | |
| 366 | if (parent != NULL) { |
Stefan Richter | 748086e | 2007-01-27 16:59:15 +0100 | [diff] [blame] | 367 | /* min() macro doesn't work here with gcc 3.4 */ |
| 368 | node->max_speed = parent->max_speed < node->phy_speed ? |
| 369 | parent->max_speed : node->phy_speed; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 370 | node->b_path = parent->b_path && b_path; |
| 371 | } else { |
| 372 | node->max_speed = node->phy_speed; |
| 373 | node->b_path = b_path; |
| 374 | } |
| 375 | |
| 376 | fw_node_event(card, node, FW_NODE_CREATED); |
| 377 | } |
| 378 | |
| 379 | void fw_destroy_nodes(struct fw_card *card) |
| 380 | { |
| 381 | unsigned long flags; |
| 382 | |
| 383 | spin_lock_irqsave(&card->lock, flags); |
| 384 | card->color++; |
| 385 | if (card->local_node != NULL) |
| 386 | for_each_fw_node(card, card->local_node, report_lost_node); |
Stefan Richter | 1580347 | 2008-02-24 18:57:23 +0100 | [diff] [blame] | 387 | card->local_node = NULL; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 388 | spin_unlock_irqrestore(&card->lock, flags); |
| 389 | } |
| 390 | |
| 391 | static void move_tree(struct fw_node *node0, struct fw_node *node1, int port) |
| 392 | { |
| 393 | struct fw_node *tree; |
| 394 | int i; |
| 395 | |
Stefan Richter | dae1a3a | 2007-06-17 23:39:58 +0200 | [diff] [blame] | 396 | tree = node1->ports[port]; |
| 397 | node0->ports[port] = tree; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 398 | for (i = 0; i < tree->port_count; i++) { |
Stefan Richter | dae1a3a | 2007-06-17 23:39:58 +0200 | [diff] [blame] | 399 | if (tree->ports[i] == node1) { |
| 400 | tree->ports[i] = node0; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 401 | break; |
| 402 | } |
| 403 | } |
| 404 | } |
| 405 | |
| 406 | /** |
| 407 | * update_tree - compare the old topology tree for card with the new |
| 408 | * one specified by root. Queue the nodes and mark them as either |
| 409 | * found, lost or updated. Update the nodes in the card topology tree |
| 410 | * as we go. |
| 411 | */ |
| 412 | static void |
Kristian Høgsberg | 83db801 | 2007-01-26 00:37:50 -0500 | [diff] [blame] | 413 | update_tree(struct fw_card *card, struct fw_node *root) |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 414 | { |
| 415 | struct list_head list0, list1; |
| 416 | struct fw_node *node0, *node1; |
| 417 | int i, event; |
| 418 | |
| 419 | INIT_LIST_HEAD(&list0); |
| 420 | list_add_tail(&card->local_node->link, &list0); |
| 421 | INIT_LIST_HEAD(&list1); |
| 422 | list_add_tail(&root->link, &list1); |
| 423 | |
| 424 | node0 = fw_node(list0.next); |
| 425 | node1 = fw_node(list1.next); |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 426 | |
| 427 | while (&node0->link != &list0) { |
Stefan Richter | a2cdebe | 2008-03-08 22:38:16 +0100 | [diff] [blame] | 428 | WARN_ON(node0->port_count != node1->port_count); |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 429 | |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 430 | if (node0->link_on && !node1->link_on) |
| 431 | event = FW_NODE_LINK_OFF; |
| 432 | else if (!node0->link_on && node1->link_on) |
| 433 | event = FW_NODE_LINK_ON; |
Stefan Richter | c9755e1 | 2008-03-24 20:54:28 +0100 | [diff] [blame] | 434 | else if (node1->initiated_reset && node1->link_on) |
| 435 | event = FW_NODE_INITIATED_RESET; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 436 | else |
| 437 | event = FW_NODE_UPDATED; |
| 438 | |
| 439 | node0->node_id = node1->node_id; |
| 440 | node0->color = card->color; |
| 441 | node0->link_on = node1->link_on; |
| 442 | node0->initiated_reset = node1->initiated_reset; |
Kristian Høgsberg | 83db801 | 2007-01-26 00:37:50 -0500 | [diff] [blame] | 443 | node0->max_hops = node1->max_hops; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 444 | node1->color = card->color; |
| 445 | fw_node_event(card, node0, event); |
| 446 | |
| 447 | if (card->root_node == node1) |
| 448 | card->root_node = node0; |
| 449 | if (card->irm_node == node1) |
| 450 | card->irm_node = node0; |
| 451 | |
| 452 | for (i = 0; i < node0->port_count; i++) { |
Stefan Richter | dae1a3a | 2007-06-17 23:39:58 +0200 | [diff] [blame] | 453 | if (node0->ports[i] && node1->ports[i]) { |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 454 | /* |
| 455 | * This port didn't change, queue the |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 456 | * connected node for further |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 457 | * investigation. |
| 458 | */ |
Stefan Richter | dae1a3a | 2007-06-17 23:39:58 +0200 | [diff] [blame] | 459 | if (node0->ports[i]->color == card->color) |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 460 | continue; |
Stefan Richter | dae1a3a | 2007-06-17 23:39:58 +0200 | [diff] [blame] | 461 | list_add_tail(&node0->ports[i]->link, &list0); |
| 462 | list_add_tail(&node1->ports[i]->link, &list1); |
| 463 | } else if (node0->ports[i]) { |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 464 | /* |
| 465 | * The nodes connected here were |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 466 | * unplugged; unref the lost nodes and |
| 467 | * queue FW_NODE_LOST callbacks for |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 468 | * them. |
| 469 | */ |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 470 | |
Stefan Richter | dae1a3a | 2007-06-17 23:39:58 +0200 | [diff] [blame] | 471 | for_each_fw_node(card, node0->ports[i], |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 472 | report_lost_node); |
Stefan Richter | dae1a3a | 2007-06-17 23:39:58 +0200 | [diff] [blame] | 473 | node0->ports[i] = NULL; |
| 474 | } else if (node1->ports[i]) { |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 475 | /* |
| 476 | * One or more node were connected to |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 477 | * this port. Move the new nodes into |
| 478 | * the tree and queue FW_NODE_CREATED |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 479 | * callbacks for them. |
| 480 | */ |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 481 | move_tree(node0, node1, i); |
Stefan Richter | dae1a3a | 2007-06-17 23:39:58 +0200 | [diff] [blame] | 482 | for_each_fw_node(card, node0->ports[i], |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 483 | report_found_node); |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 484 | } |
| 485 | } |
| 486 | |
| 487 | node0 = fw_node(node0->link.next); |
| 488 | node1 = fw_node(node1->link.next); |
| 489 | } |
| 490 | } |
| 491 | |
Kristian Høgsberg | 473d28c | 2007-03-07 12:12:55 -0500 | [diff] [blame] | 492 | static void |
| 493 | update_topology_map(struct fw_card *card, u32 *self_ids, int self_id_count) |
| 494 | { |
| 495 | int node_count; |
Kristian Høgsberg | 473d28c | 2007-03-07 12:12:55 -0500 | [diff] [blame] | 496 | |
| 497 | card->topology_map[1]++; |
| 498 | node_count = (card->root_node->node_id & 0x3f) + 1; |
| 499 | card->topology_map[2] = (node_count << 16) | self_id_count; |
Kristian Høgsberg | e175569 | 2007-05-07 20:33:31 -0400 | [diff] [blame] | 500 | card->topology_map[0] = (self_id_count + 2) << 16; |
Kristian Høgsberg | 473d28c | 2007-03-07 12:12:55 -0500 | [diff] [blame] | 501 | memcpy(&card->topology_map[3], self_ids, self_id_count * 4); |
Kristian Høgsberg | e175569 | 2007-05-07 20:33:31 -0400 | [diff] [blame] | 502 | fw_compute_block_crc(card->topology_map); |
Kristian Høgsberg | 473d28c | 2007-03-07 12:12:55 -0500 | [diff] [blame] | 503 | } |
| 504 | |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 505 | void |
| 506 | fw_core_handle_bus_reset(struct fw_card *card, |
| 507 | int node_id, int generation, |
| 508 | int self_id_count, u32 * self_ids) |
| 509 | { |
| 510 | struct fw_node *local_node; |
| 511 | unsigned long flags; |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 512 | |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 513 | spin_lock_irqsave(&card->lock, flags); |
| 514 | |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 515 | /* |
| 516 | * If the new topology has a different self_id_count the topology |
Kristian Høgsberg | 83db801 | 2007-01-26 00:37:50 -0500 | [diff] [blame] | 517 | * changed, either nodes were added or removed. In that case we |
Kristian Høgsberg | c781c06 | 2007-05-07 20:33:32 -0400 | [diff] [blame] | 518 | * reset the IRM reset counter. |
| 519 | */ |
Kristian Høgsberg | 83db801 | 2007-01-26 00:37:50 -0500 | [diff] [blame] | 520 | if (card->self_id_count != self_id_count) |
Kristian Høgsberg | 931c483 | 2007-01-26 00:38:45 -0500 | [diff] [blame] | 521 | card->bm_retries = 0; |
Kristian Høgsberg | 83db801 | 2007-01-26 00:37:50 -0500 | [diff] [blame] | 522 | |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 523 | card->node_id = node_id; |
Stefan Richter | b5d2a5e | 2008-01-25 18:57:41 +0100 | [diff] [blame] | 524 | /* |
| 525 | * Update node_id before generation to prevent anybody from using |
| 526 | * a stale node_id together with a current generation. |
| 527 | */ |
| 528 | smp_wmb(); |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 529 | card->generation = generation; |
Kristian Høgsberg | 931c483 | 2007-01-26 00:38:45 -0500 | [diff] [blame] | 530 | card->reset_jiffies = jiffies; |
Kristian Høgsberg | 993baca | 2007-02-06 14:49:35 -0500 | [diff] [blame] | 531 | schedule_delayed_work(&card->work, 0); |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 532 | |
Kristian Høgsberg | 473d28c | 2007-03-07 12:12:55 -0500 | [diff] [blame] | 533 | local_node = build_tree(card, self_ids, self_id_count); |
| 534 | |
| 535 | update_topology_map(card, self_ids, self_id_count); |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 536 | |
| 537 | card->color++; |
| 538 | |
| 539 | if (local_node == NULL) { |
| 540 | fw_error("topology build failed\n"); |
| 541 | /* FIXME: We need to issue a bus reset in this case. */ |
| 542 | } else if (card->local_node == NULL) { |
| 543 | card->local_node = local_node; |
| 544 | for_each_fw_node(card, local_node, report_found_node); |
| 545 | } else { |
Kristian Høgsberg | 83db801 | 2007-01-26 00:37:50 -0500 | [diff] [blame] | 546 | update_tree(card, local_node); |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 547 | } |
| 548 | |
| 549 | spin_unlock_irqrestore(&card->lock, flags); |
| 550 | } |
Kristian Høgsberg | 3038e35 | 2006-12-19 19:58:27 -0500 | [diff] [blame] | 551 | EXPORT_SYMBOL(fw_core_handle_bus_reset); |