blob: a5dd7a665aa89e1551dd89653af01234a0d2adc8 [file] [log] [blame]
Kristian Høgsbergc781c062007-05-07 20:33:32 -04001/*
2 * Copyright (C) 2005-2007 Kristian Hoegsberg <krh@bitplanet.net>
Kristian Høgsberg3038e352006-12-19 19:58:27 -05003 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software Foundation,
16 * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
17 */
18
Stefan Richter459f7922008-05-24 16:50:22 +020019#include <linux/completion.h>
20#include <linux/crc-itu-t.h>
Stefan Richter855c6032008-02-27 22:14:27 +010021#include <linux/delay.h>
Kristian Høgsberg3038e352006-12-19 19:58:27 -050022#include <linux/device.h>
Stefan Richter459f7922008-05-24 16:50:22 +020023#include <linux/errno.h>
24#include <linux/kref.h>
25#include <linux/module.h>
Kristian Høgsberg6a5033b2007-05-07 20:33:33 -040026#include <linux/mutex.h>
Stefan Richter459f7922008-05-24 16:50:22 +020027
Kristian Høgsberg3038e352006-12-19 19:58:27 -050028#include "fw-transaction.h"
29#include "fw-topology.h"
Kristian Høgsberg19a15b92006-12-19 19:58:31 -050030#include "fw-device.h"
Kristian Høgsberg3038e352006-12-19 19:58:27 -050031
Kristian Høgsberge1755692007-05-07 20:33:31 -040032int fw_compute_block_crc(u32 *block)
Kristian Høgsberg3038e352006-12-19 19:58:27 -050033{
Kristian Høgsberge1755692007-05-07 20:33:31 -040034 __be32 be32_block[256];
35 int i, length;
Kristian Høgsberg3038e352006-12-19 19:58:27 -050036
Kristian Høgsberge1755692007-05-07 20:33:31 -040037 length = (*block >> 16) & 0xff;
38 for (i = 0; i < length; i++)
39 be32_block[i] = cpu_to_be32(block[i + 1]);
40 *block |= crc_itu_t(0, (u8 *) be32_block, length * 4);
Kristian Høgsberg3038e352006-12-19 19:58:27 -050041
Kristian Høgsberge1755692007-05-07 20:33:31 -040042 return length;
Kristian Høgsberg3038e352006-12-19 19:58:27 -050043}
44
Kristian Høgsberg6a5033b2007-05-07 20:33:33 -040045static DEFINE_MUTEX(card_mutex);
Kristian Høgsberg3038e352006-12-19 19:58:27 -050046static LIST_HEAD(card_list);
47
48static LIST_HEAD(descriptor_list);
49static int descriptor_count;
50
Kristian Høgsberga77754a2007-05-07 20:33:35 -040051#define BIB_CRC(v) ((v) << 0)
52#define BIB_CRC_LENGTH(v) ((v) << 16)
53#define BIB_INFO_LENGTH(v) ((v) << 24)
Kristian Høgsberg3038e352006-12-19 19:58:27 -050054
Kristian Høgsberga77754a2007-05-07 20:33:35 -040055#define BIB_LINK_SPEED(v) ((v) << 0)
56#define BIB_GENERATION(v) ((v) << 4)
57#define BIB_MAX_ROM(v) ((v) << 8)
58#define BIB_MAX_RECEIVE(v) ((v) << 12)
59#define BIB_CYC_CLK_ACC(v) ((v) << 16)
60#define BIB_PMC ((1) << 27)
61#define BIB_BMC ((1) << 28)
62#define BIB_ISC ((1) << 29)
63#define BIB_CMC ((1) << 30)
64#define BIB_IMC ((1) << 31)
Kristian Høgsberg3038e352006-12-19 19:58:27 -050065
66static u32 *
Kristian Høgsberga98e2712007-05-07 20:33:34 -040067generate_config_rom(struct fw_card *card, size_t *config_rom_length)
Kristian Høgsberg3038e352006-12-19 19:58:27 -050068{
69 struct fw_descriptor *desc;
70 static u32 config_rom[256];
71 int i, j, length;
72
Kristian Høgsbergc781c062007-05-07 20:33:32 -040073 /*
74 * Initialize contents of config rom buffer. On the OHCI
Stefan Richter5e20c282007-01-21 20:44:09 +010075 * controller, block reads to the config rom accesses the host
76 * memory, but quadlet read access the hardware bus info block
77 * registers. That's just crack, but it means we should make
Jay Fenlason2cc489c2008-10-22 15:59:42 -040078 * sure the contents of bus info block in host memory matches
Kristian Høgsbergc781c062007-05-07 20:33:32 -040079 * the version stored in the OHCI registers.
80 */
Kristian Høgsberg3038e352006-12-19 19:58:27 -050081
Kristian Høgsberg2d826cc2007-05-09 19:23:14 -040082 memset(config_rom, 0, sizeof(config_rom));
Kristian Høgsberga77754a2007-05-07 20:33:35 -040083 config_rom[0] = BIB_CRC_LENGTH(4) | BIB_INFO_LENGTH(4) | BIB_CRC(0);
Kristian Høgsberg3038e352006-12-19 19:58:27 -050084 config_rom[1] = 0x31333934;
85
86 config_rom[2] =
Kristian Høgsberga77754a2007-05-07 20:33:35 -040087 BIB_LINK_SPEED(card->link_speed) |
88 BIB_GENERATION(card->config_rom_generation++ % 14 + 2) |
89 BIB_MAX_ROM(2) |
90 BIB_MAX_RECEIVE(card->max_receive) |
91 BIB_BMC | BIB_ISC | BIB_CMC | BIB_IMC;
Kristian Høgsberg3038e352006-12-19 19:58:27 -050092 config_rom[3] = card->guid >> 32;
93 config_rom[4] = card->guid;
94
95 /* Generate root directory. */
96 i = 5;
97 config_rom[i++] = 0;
98 config_rom[i++] = 0x0c0083c0; /* node capabilities */
Kristian Høgsberg3038e352006-12-19 19:58:27 -050099 j = i + descriptor_count;
100
101 /* Generate root directory entries for descriptors. */
102 list_for_each_entry (desc, &descriptor_list, link) {
Kristian Høgsberg937f6872007-03-07 12:12:36 -0500103 if (desc->immediate > 0)
104 config_rom[i++] = desc->immediate;
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500105 config_rom[i] = desc->key | (j - i);
106 i++;
107 j += desc->length;
108 }
109
110 /* Update root directory length. */
111 config_rom[5] = (i - 5 - 1) << 16;
112
113 /* End of root directory, now copy in descriptors. */
114 list_for_each_entry (desc, &descriptor_list, link) {
115 memcpy(&config_rom[i], desc->data, desc->length * 4);
116 i += desc->length;
117 }
118
119 /* Calculate CRCs for all blocks in the config rom. This
120 * assumes that CRC length and info length are identical for
121 * the bus info block, which is always the case for this
122 * implementation. */
Kristian Høgsberge1755692007-05-07 20:33:31 -0400123 for (i = 0; i < j; i += length + 1)
124 length = fw_compute_block_crc(config_rom + i);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500125
126 *config_rom_length = j;
127
128 return config_rom;
129}
130
131static void
Kristian Høgsberga98e2712007-05-07 20:33:34 -0400132update_config_roms(void)
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500133{
134 struct fw_card *card;
135 u32 *config_rom;
136 size_t length;
137
138 list_for_each_entry (card, &card_list, link) {
139 config_rom = generate_config_rom(card, &length);
140 card->driver->set_config_rom(card, config_rom, length);
141 }
142}
143
144int
Kristian Høgsberga98e2712007-05-07 20:33:34 -0400145fw_core_add_descriptor(struct fw_descriptor *desc)
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500146{
147 size_t i;
148
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400149 /*
150 * Check descriptor is valid; the length of all blocks in the
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500151 * descriptor has to add up to exactly the length of the
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400152 * block.
153 */
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500154 i = 0;
155 while (i < desc->length)
156 i += (desc->data[i] >> 16) + 1;
157
158 if (i != desc->length)
Kristian Høgsberg66dea3e2007-03-28 21:26:42 +0200159 return -EINVAL;
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500160
Kristian Høgsberg6a5033b2007-05-07 20:33:33 -0400161 mutex_lock(&card_mutex);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500162
Kristian Høgsberga98e2712007-05-07 20:33:34 -0400163 list_add_tail(&desc->link, &descriptor_list);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500164 descriptor_count++;
Kristian Høgsberg937f6872007-03-07 12:12:36 -0500165 if (desc->immediate > 0)
166 descriptor_count++;
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500167 update_config_roms();
168
Kristian Høgsberg6a5033b2007-05-07 20:33:33 -0400169 mutex_unlock(&card_mutex);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500170
171 return 0;
172}
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500173
174void
Kristian Høgsberga98e2712007-05-07 20:33:34 -0400175fw_core_remove_descriptor(struct fw_descriptor *desc)
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500176{
Kristian Høgsberg6a5033b2007-05-07 20:33:33 -0400177 mutex_lock(&card_mutex);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500178
179 list_del(&desc->link);
180 descriptor_count--;
Kristian Høgsberg937f6872007-03-07 12:12:36 -0500181 if (desc->immediate > 0)
182 descriptor_count--;
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500183 update_config_roms();
184
Kristian Høgsberg6a5033b2007-05-07 20:33:33 -0400185 mutex_unlock(&card_mutex);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500186}
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500187
Kristian Høgsberg83db8012007-01-26 00:37:50 -0500188static const char gap_count_table[] = {
189 63, 5, 7, 8, 10, 13, 16, 18, 21, 24, 26, 29, 32, 35, 37, 40
190};
191
Jay Fenlason0fa1986f2008-11-29 17:44:57 +0100192void
193fw_schedule_bm_work(struct fw_card *card, unsigned long delay)
194{
195 int scheduled;
196
197 fw_card_get(card);
198 scheduled = schedule_delayed_work(&card->work, delay);
199 if (!scheduled)
200 fw_card_put(card);
201}
202
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500203static void
204fw_card_bm_work(struct work_struct *work)
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500205{
Kristian Høgsberg83db8012007-01-26 00:37:50 -0500206 struct fw_card *card = container_of(work, struct fw_card, work.work);
Stefan Richter15803472008-02-24 18:57:23 +0100207 struct fw_device *root_device;
208 struct fw_node *root_node, *local_node;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500209 unsigned long flags;
Jay Fenlason1e119fa2008-07-20 14:20:53 +0200210 int root_id, new_root_id, irm_id, gap_count, generation, grace, rcode;
Stefan Richter25b1c3d2008-03-24 20:57:12 +0100211 bool do_reset = false;
Stefan Richter62305822009-01-09 20:49:37 +0100212 bool root_device_is_running;
213 bool root_device_is_cmc;
Jay Fenlason1e119fa2008-07-20 14:20:53 +0200214 __be32 lock_data[2];
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500215
216 spin_lock_irqsave(&card->lock, flags);
Stefan Richter15803472008-02-24 18:57:23 +0100217 local_node = card->local_node;
218 root_node = card->root_node;
219
220 if (local_node == NULL) {
221 spin_unlock_irqrestore(&card->lock, flags);
Jay Fenlason0fa1986f2008-11-29 17:44:57 +0100222 goto out_put_card;
Stefan Richter15803472008-02-24 18:57:23 +0100223 }
224 fw_node_get(local_node);
225 fw_node_get(root_node);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500226
227 generation = card->generation;
Stefan Richter15803472008-02-24 18:57:23 +0100228 root_device = root_node->data;
Stefan Richter62305822009-01-09 20:49:37 +0100229 root_device_is_running = root_device &&
230 atomic_read(&root_device->state) == FW_DEVICE_RUNNING;
231 root_device_is_cmc = root_device && root_device->cmc;
Stefan Richter15803472008-02-24 18:57:23 +0100232 root_id = root_node->node_id;
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500233 grace = time_after(jiffies, card->reset_jiffies + DIV_ROUND_UP(HZ, 10));
234
Stefan Richter8cd0bbb2008-03-24 20:56:40 +0100235 if (is_next_generation(generation, card->bm_generation) ||
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500236 (card->bm_generation != generation && grace)) {
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400237 /*
238 * This first step is to figure out who is IRM and
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500239 * then try to become bus manager. If the IRM is not
240 * well defined (e.g. does not have an active link
241 * layer or does not responds to our lock request, we
242 * will have to do a little vigilante bus management.
243 * In that case, we do a goto into the gap count logic
244 * so that when we do the reset, we still optimize the
245 * gap count. That could well save a reset in the
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400246 * next generation.
247 */
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500248
249 irm_id = card->irm_node->node_id;
250 if (!card->irm_node->link_on) {
Stefan Richter15803472008-02-24 18:57:23 +0100251 new_root_id = local_node->node_id;
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500252 fw_notify("IRM has link off, making local node (%02x) root.\n",
253 new_root_id);
254 goto pick_me;
255 }
256
Jay Fenlason1e119fa2008-07-20 14:20:53 +0200257 lock_data[0] = cpu_to_be32(0x3f);
258 lock_data[1] = cpu_to_be32(local_node->node_id);
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500259
260 spin_unlock_irqrestore(&card->lock, flags);
261
Jay Fenlason1e119fa2008-07-20 14:20:53 +0200262 rcode = fw_run_transaction(card, TCODE_LOCK_COMPARE_SWAP,
263 irm_id, generation, SCODE_100,
264 CSR_REGISTER_BASE + CSR_BUS_MANAGER_ID,
265 lock_data, sizeof(lock_data));
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500266
Jay Fenlason1e119fa2008-07-20 14:20:53 +0200267 if (rcode == RCODE_GENERATION)
268 /* Another bus reset, BM work has been rescheduled. */
Stefan Richter15803472008-02-24 18:57:23 +0100269 goto out;
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500270
Jay Fenlason1e119fa2008-07-20 14:20:53 +0200271 if (rcode == RCODE_COMPLETE &&
272 lock_data[0] != cpu_to_be32(0x3f))
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500273 /* Somebody else is BM, let them do the work. */
Stefan Richter15803472008-02-24 18:57:23 +0100274 goto out;
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500275
276 spin_lock_irqsave(&card->lock, flags);
Jay Fenlason1e119fa2008-07-20 14:20:53 +0200277
278 if (rcode != RCODE_COMPLETE) {
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400279 /*
280 * The lock request failed, maybe the IRM
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500281 * isn't really IRM capable after all. Let's
282 * do a bus reset and pick the local node as
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400283 * root, and thus, IRM.
284 */
Stefan Richter15803472008-02-24 18:57:23 +0100285 new_root_id = local_node->node_id;
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500286 fw_notify("BM lock failed, making local node (%02x) root.\n",
287 new_root_id);
288 goto pick_me;
289 }
290 } else if (card->bm_generation != generation) {
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400291 /*
292 * OK, we weren't BM in the last generation, and it's
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500293 * less than 100ms since last bus reset. Reschedule
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400294 * this task 100ms from now.
295 */
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500296 spin_unlock_irqrestore(&card->lock, flags);
Jay Fenlason0fa1986f2008-11-29 17:44:57 +0100297 fw_schedule_bm_work(card, DIV_ROUND_UP(HZ, 10));
Stefan Richter15803472008-02-24 18:57:23 +0100298 goto out;
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500299 }
300
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400301 /*
302 * We're bus manager for this generation, so next step is to
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500303 * make sure we have an active cycle master and do gap count
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400304 * optimization.
305 */
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500306 card->bm_generation = generation;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500307
Stefan Richter15803472008-02-24 18:57:23 +0100308 if (root_device == NULL) {
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400309 /*
310 * Either link_on is false, or we failed to read the
311 * config rom. In either case, pick another root.
312 */
Stefan Richter15803472008-02-24 18:57:23 +0100313 new_root_id = local_node->node_id;
Stefan Richter62305822009-01-09 20:49:37 +0100314 } else if (!root_device_is_running) {
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400315 /*
316 * If we haven't probed this device yet, bail out now
317 * and let's try again once that's done.
318 */
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500319 spin_unlock_irqrestore(&card->lock, flags);
Stefan Richter15803472008-02-24 18:57:23 +0100320 goto out;
Stefan Richter62305822009-01-09 20:49:37 +0100321 } else if (root_device_is_cmc) {
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400322 /*
323 * FIXME: I suppose we should set the cmstr bit in the
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500324 * STATE_CLEAR register of this node, as described in
325 * 1394-1995, 8.4.2.6. Also, send out a force root
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400326 * packet for this node.
327 */
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500328 new_root_id = root_id;
Kristian Høgsberg83db8012007-01-26 00:37:50 -0500329 } else {
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400330 /*
331 * Current root has an active link layer and we
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500332 * successfully read the config rom, but it's not
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400333 * cycle master capable.
334 */
Stefan Richter15803472008-02-24 18:57:23 +0100335 new_root_id = local_node->node_id;
Kristian Høgsberg83db8012007-01-26 00:37:50 -0500336 }
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500337
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500338 pick_me:
Stefan Richter24d40122007-06-18 19:44:12 +0200339 /*
340 * Pick a gap count from 1394a table E-1. The table doesn't cover
341 * the typically much larger 1394b beta repeater delays though.
342 */
343 if (!card->beta_repeaters_present &&
Stefan Richter15803472008-02-24 18:57:23 +0100344 root_node->max_hops < ARRAY_SIZE(gap_count_table))
345 gap_count = gap_count_table[root_node->max_hops];
Kristian Høgsberg83db8012007-01-26 00:37:50 -0500346 else
347 gap_count = 63;
348
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400349 /*
Stefan Richter25b1c3d2008-03-24 20:57:12 +0100350 * Finally, figure out if we should do a reset or not. If we have
351 * done less than 5 resets with the same physical topology and we
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400352 * have either a new root or a new gap count setting, let's do it.
353 */
Kristian Høgsberg83db8012007-01-26 00:37:50 -0500354
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500355 if (card->bm_retries++ < 5 &&
356 (card->gap_count != gap_count || new_root_id != root_id))
Stefan Richter25b1c3d2008-03-24 20:57:12 +0100357 do_reset = true;
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500358
359 spin_unlock_irqrestore(&card->lock, flags);
360
Kristian Høgsberg83db8012007-01-26 00:37:50 -0500361 if (do_reset) {
362 fw_notify("phy config: card %d, new root=%x, gap_count=%d\n",
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500363 card->index, new_root_id, gap_count);
364 fw_send_phy_config(card, new_root_id, generation, gap_count);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500365 fw_core_initiate_bus_reset(card, 1);
366 }
Stefan Richter15803472008-02-24 18:57:23 +0100367 out:
Stefan Richter15803472008-02-24 18:57:23 +0100368 fw_node_put(root_node);
369 fw_node_put(local_node);
Jay Fenlason0fa1986f2008-11-29 17:44:57 +0100370 out_put_card:
371 fw_card_put(card);
Kristian Høgsberg19a15b92006-12-19 19:58:31 -0500372}
373
374static void
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500375flush_timer_callback(unsigned long data)
376{
377 struct fw_card *card = (struct fw_card *)data;
378
379 fw_flush_transactions(card);
380}
381
382void
Stefan Richter21ebcd12007-01-14 15:29:07 +0100383fw_card_initialize(struct fw_card *card, const struct fw_card_driver *driver,
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500384 struct device *device)
385{
Kristian Høgsbergbbf19db2007-02-06 14:49:38 -0500386 static atomic_t index = ATOMIC_INIT(-1);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500387
Kristian Høgsbergbbf19db2007-02-06 14:49:38 -0500388 card->index = atomic_inc_return(&index);
Stefan Richter5e20c282007-01-21 20:44:09 +0100389 card->driver = driver;
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500390 card->device = device;
Stefan Richter5e20c282007-01-21 20:44:09 +0100391 card->current_tlabel = 0;
392 card->tlabel_mask = 0;
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500393 card->color = 0;
Stefan Richtere534fe12008-05-24 16:41:09 +0200394 card->broadcast_channel = BROADCAST_CHANNEL_INITIAL;
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500395
Stefan Richter459f7922008-05-24 16:50:22 +0200396 kref_init(&card->kref);
397 init_completion(&card->done);
Stefan Richter5e20c282007-01-21 20:44:09 +0100398 INIT_LIST_HEAD(&card->transaction_list);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500399 spin_lock_init(&card->lock);
400 setup_timer(&card->flush_timer,
401 flush_timer_callback, (unsigned long)card);
402
403 card->local_node = NULL;
404
Kristian Høgsberg931c4832007-01-26 00:38:45 -0500405 INIT_DELAYED_WORK(&card->work, fw_card_bm_work);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500406}
407EXPORT_SYMBOL(fw_card_initialize);
408
409int
410fw_card_add(struct fw_card *card,
411 u32 max_receive, u32 link_speed, u64 guid)
412{
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500413 u32 *config_rom;
414 size_t length;
Petr Vandrovecb7479fe2009-02-01 01:29:35 -0800415 int err;
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500416
417 card->max_receive = max_receive;
418 card->link_speed = link_speed;
419 card->guid = guid;
420
Kristian Høgsberg6a5033b2007-05-07 20:33:33 -0400421 mutex_lock(&card_mutex);
Kristian Høgsberga98e2712007-05-07 20:33:34 -0400422 config_rom = generate_config_rom(card, &length);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500423 list_add_tail(&card->link, &card_list);
Kristian Høgsberg6a5033b2007-05-07 20:33:33 -0400424 mutex_unlock(&card_mutex);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500425
Petr Vandrovecb7479fe2009-02-01 01:29:35 -0800426 err = card->driver->enable(card, config_rom, length);
427 if (err < 0) {
428 mutex_lock(&card_mutex);
429 list_del(&card->link);
430 mutex_unlock(&card_mutex);
431 }
432 return err;
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500433}
434EXPORT_SYMBOL(fw_card_add);
435
436
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400437/*
438 * The next few functions implements a dummy driver that use once a
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500439 * card driver shuts down an fw_card. This allows the driver to
440 * cleanly unload, as all IO to the card will be handled by the dummy
441 * driver instead of calling into the (possibly) unloaded module. The
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400442 * dummy driver just fails all IO.
443 */
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500444
445static int
446dummy_enable(struct fw_card *card, u32 *config_rom, size_t length)
447{
448 BUG();
449 return -1;
450}
451
452static int
453dummy_update_phy_reg(struct fw_card *card, int address,
454 int clear_bits, int set_bits)
455{
456 return -ENODEV;
457}
458
459static int
460dummy_set_config_rom(struct fw_card *card,
461 u32 *config_rom, size_t length)
462{
Kristian Høgsbergc781c062007-05-07 20:33:32 -0400463 /*
464 * We take the card out of card_list before setting the dummy
465 * driver, so this should never get called.
466 */
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500467 BUG();
468 return -1;
469}
470
471static void
472dummy_send_request(struct fw_card *card, struct fw_packet *packet)
473{
Stefan Richter5e20c282007-01-21 20:44:09 +0100474 packet->callback(packet, card, -ENODEV);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500475}
476
477static void
478dummy_send_response(struct fw_card *card, struct fw_packet *packet)
479{
Stefan Richter5e20c282007-01-21 20:44:09 +0100480 packet->callback(packet, card, -ENODEV);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500481}
482
483static int
Kristian Høgsberg730c32f2007-02-06 14:49:32 -0500484dummy_cancel_packet(struct fw_card *card, struct fw_packet *packet)
485{
486 return -ENOENT;
487}
488
489static int
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500490dummy_enable_phys_dma(struct fw_card *card,
491 int node_id, int generation)
492{
493 return -ENODEV;
494}
495
496static struct fw_card_driver dummy_driver = {
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500497 .enable = dummy_enable,
498 .update_phy_reg = dummy_update_phy_reg,
499 .set_config_rom = dummy_set_config_rom,
Stefan Richter5e20c282007-01-21 20:44:09 +0100500 .send_request = dummy_send_request,
Kristian Høgsberg730c32f2007-02-06 14:49:32 -0500501 .cancel_packet = dummy_cancel_packet,
Stefan Richter5e20c282007-01-21 20:44:09 +0100502 .send_response = dummy_send_response,
Stefan Richter5af4e5e2007-01-21 20:45:32 +0100503 .enable_phys_dma = dummy_enable_phys_dma,
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500504};
505
506void
Stefan Richter459f7922008-05-24 16:50:22 +0200507fw_card_release(struct kref *kref)
508{
509 struct fw_card *card = container_of(kref, struct fw_card, kref);
510
511 complete(&card->done);
512}
513
514void
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500515fw_core_remove_card(struct fw_card *card)
516{
Marc Butlerecab4132007-03-23 10:24:02 -0600517 card->driver->update_phy_reg(card, 4,
518 PHY_LINK_ACTIVE | PHY_CONTENDER, 0);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500519 fw_core_initiate_bus_reset(card, 1);
520
Kristian Høgsberg6a5033b2007-05-07 20:33:33 -0400521 mutex_lock(&card_mutex);
Stefan Richtere747a5c2009-01-24 20:35:38 +0100522 list_del_init(&card->link);
Kristian Høgsberg6a5033b2007-05-07 20:33:33 -0400523 mutex_unlock(&card_mutex);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500524
525 /* Set up the dummy driver. */
526 card->driver = &dummy_driver;
527
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500528 fw_destroy_nodes(card);
Stefan Richter459f7922008-05-24 16:50:22 +0200529
530 /* Wait for all users, especially device workqueue jobs, to finish. */
531 fw_card_put(card);
532 wait_for_completion(&card->done);
Stefan Richter8a2d9ed2007-08-21 01:05:14 +0200533
Stefan Richter1e8afea2008-07-12 14:51:18 +0200534 WARN_ON(!list_empty(&card->transaction_list));
Stefan Richter8a2d9ed2007-08-21 01:05:14 +0200535 del_timer_sync(&card->flush_timer);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500536}
537EXPORT_SYMBOL(fw_core_remove_card);
538
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500539int
540fw_core_initiate_bus_reset(struct fw_card *card, int short_reset)
541{
Marc Butlerecab4132007-03-23 10:24:02 -0600542 int reg = short_reset ? 5 : 1;
Marc Butlerecab4132007-03-23 10:24:02 -0600543 int bit = short_reset ? PHY_BUS_SHORT_RESET : PHY_BUS_RESET;
544
545 return card->driver->update_phy_reg(card, reg, 0, bit);
Kristian Høgsberg3038e352006-12-19 19:58:27 -0500546}
547EXPORT_SYMBOL(fw_core_initiate_bus_reset);