ieee1394_core.c 36.6 KB
Newer Older
Linus Torvalds's avatar
Linus Torvalds committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33
/*
 * IEEE 1394 for Linux
 *
 * Core support: hpsb_packet management, packet handling and forwarding to
 *               highlevel or lowlevel code
 *
 * Copyright (C) 1999, 2000 Andreas E. Bombe
 *                     2002 Manfred Weihs <weihs@ict.tuwien.ac.at>
 *
 * This code is licensed under the GPL.  See the file COPYING in the root
 * directory of the kernel sources for details.
 *
 *
 * Contributions:
 *
 * Manfred Weihs <weihs@ict.tuwien.ac.at>
 *        loopback functionality in hpsb_send_packet
 *        allow highlevel drivers to disable automatic response generation
 *              and to generate responses themselves (deferred)
 *
 */

#include <linux/kernel.h>
#include <linux/list.h>
#include <linux/string.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/interrupt.h>
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/bitops.h>
#include <linux/kdev_t.h>
#include <linux/suspend.h>
34
#include <linux/kthread.h>
35 36
#include <linux/preempt.h>
#include <linux/time.h>
Linus Torvalds's avatar
Linus Torvalds committed
37

38
#include <asm/system.h>
Linus Torvalds's avatar
Linus Torvalds committed
39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55
#include <asm/byteorder.h>

#include "ieee1394_types.h"
#include "ieee1394.h"
#include "hosts.h"
#include "ieee1394_core.h"
#include "highlevel.h"
#include "ieee1394_transactions.h"
#include "csr.h"
#include "nodemgr.h"
#include "dma.h"
#include "iso.h"
#include "config_roms.h"

/*
 * Disable the nodemgr detection and config rom reading functionality.
 */
Ben Collins's avatar
Ben Collins committed
56
static int disable_nodemgr;
Linus Torvalds's avatar
Linus Torvalds committed
57 58 59 60 61
module_param(disable_nodemgr, int, 0444);
MODULE_PARM_DESC(disable_nodemgr, "Disable nodemgr functionality.");

/* Disable Isochronous Resource Manager functionality */
int hpsb_disable_irm = 0;
62
module_param_named(disable_irm, hpsb_disable_irm, bool, 0444);
Linus Torvalds's avatar
Linus Torvalds committed
63 64 65 66 67 68 69 70
MODULE_PARM_DESC(disable_irm,
		 "Disable Isochronous Resource Manager functionality.");

/* We are GPL, so treat us special */
MODULE_LICENSE("GPL");

/* Some globals used */
const char *hpsb_speedto_str[] = { "S100", "S200", "S400", "S800", "S1600", "S3200" };
71
struct class *hpsb_protocol_class;
Linus Torvalds's avatar
Linus Torvalds committed
72 73

#ifdef CONFIG_IEEE1394_VERBOSEDEBUG
74
static void dump_packet(const char *text, quadlet_t *data, int size, int speed)
Linus Torvalds's avatar
Linus Torvalds committed
75 76 77 78 79 80 81
{
	int i;

	size /= 4;
	size = (size > 4 ? 4 : size);

	printk(KERN_DEBUG "ieee1394: %s", text);
82 83 84
	if (speed > -1 && speed < 6)
		printk(" at %s", hpsb_speedto_str[speed]);
	printk(":");
Linus Torvalds's avatar
Linus Torvalds committed
85 86 87 88 89
	for (i = 0; i < size; i++)
		printk(" %08x", data[i]);
	printk("\n");
}
#else
90
#define dump_packet(a,b,c,d) do {} while (0)
Linus Torvalds's avatar
Linus Torvalds committed
91 92 93 94 95 96 97
#endif

static void abort_requests(struct hpsb_host *host);
static void queue_packet_complete(struct hpsb_packet *packet);


/**
98
 * hpsb_set_packet_complete_task - set task that runs when a packet completes
Linus Torvalds's avatar
Linus Torvalds committed
99 100 101
 * @packet: the packet whose completion we want the task added to
 * @routine: function to call
 * @data: data (if any) to pass to the above function
102 103 104
 *
 * Set the task that runs when a packet completes. You cannot call this more
 * than once on a single packet before it is sent.
105 106
 *
 * Typically, the complete @routine is responsible to call hpsb_free_packet().
Linus Torvalds's avatar
Linus Torvalds committed
107 108 109 110 111 112 113 114 115 116 117 118
 */
void hpsb_set_packet_complete_task(struct hpsb_packet *packet,
				   void (*routine)(void *), void *data)
{
	WARN_ON(packet->complete_routine != NULL);
	packet->complete_routine = routine;
	packet->complete_data = data;
	return;
}

/**
 * hpsb_alloc_packet - allocate new packet structure
119
 * @data_size: size of the data block to be allocated, in bytes
Linus Torvalds's avatar
Linus Torvalds committed
120 121
 *
 * This function allocates, initializes and returns a new &struct hpsb_packet.
122 123 124
 * It can be used in interrupt context.  A header block is always included and
 * initialized with zeros.  Its size is big enough to contain all possible 1394
 * headers.  The data block is only allocated if @data_size is not zero.
Linus Torvalds's avatar
Linus Torvalds committed
125 126 127 128 129 130 131 132 133 134 135 136 137 138
 *
 * For packets for which responses will be received the @data_size has to be big
 * enough to contain the response's data block since no further allocation
 * occurs at response matching time.
 *
 * The packet's generation value will be set to the current generation number
 * for ease of use.  Remember to overwrite it with your own recorded generation
 * number if you can not be sure that your code will not race with a bus reset.
 *
 * Return value: A pointer to a &struct hpsb_packet or NULL on allocation
 * failure.
 */
struct hpsb_packet *hpsb_alloc_packet(size_t data_size)
{
139
	struct hpsb_packet *packet;
Linus Torvalds's avatar
Linus Torvalds committed
140 141 142

	data_size = ((data_size + 3) & ~3);

143 144
	packet = kzalloc(sizeof(*packet) + data_size, GFP_ATOMIC);
	if (!packet)
Linus Torvalds's avatar
Linus Torvalds committed
145 146 147 148 149
		return NULL;

	packet->state = hpsb_unused;
	packet->generation = -1;
	INIT_LIST_HEAD(&packet->driver_list);
150
	INIT_LIST_HEAD(&packet->queue);
Linus Torvalds's avatar
Linus Torvalds committed
151 152 153
	atomic_set(&packet->refcnt, 1);

	if (data_size) {
154 155
		packet->data = packet->embedded_data;
		packet->allocated_data_size = data_size;
Linus Torvalds's avatar
Linus Torvalds committed
156 157 158 159 160 161 162 163
	}
	return packet;
}

/**
 * hpsb_free_packet - free packet and data associated with it
 * @packet: packet to free (is NULL safe)
 *
164
 * Frees @packet->data only if it was allocated through hpsb_alloc_packet().
Linus Torvalds's avatar
Linus Torvalds committed
165 166 167 168
 */
void hpsb_free_packet(struct hpsb_packet *packet)
{
	if (packet && atomic_dec_and_test(&packet->refcnt)) {
169 170 171
		BUG_ON(!list_empty(&packet->driver_list) ||
		       !list_empty(&packet->queue));
		kfree(packet);
Linus Torvalds's avatar
Linus Torvalds committed
172 173 174
	}
}

175 176 177 178 179 180 181
/**
 * hpsb_reset_bus - initiate bus reset on the given host
 * @host: host controller whose bus to reset
 * @type: one of enum reset_types
 *
 * Returns 1 if bus reset already in progress, 0 otherwise.
 */
Linus Torvalds's avatar
Linus Torvalds committed
182 183
int hpsb_reset_bus(struct hpsb_host *host, int type)
{
184 185 186 187 188 189
	if (!host->in_bus_reset) {
		host->driver->devctl(host, RESET_BUS, type);
		return 0;
	} else {
		return 1;
	}
Linus Torvalds's avatar
Linus Torvalds committed
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 230
/**
 * hpsb_read_cycle_timer - read cycle timer register and system time
 * @host: host whose isochronous cycle timer register is read
 * @cycle_timer: address of bitfield to return the register contents
 * @local_time: address to return the system time
 *
 * The format of * @cycle_timer, is described in OHCI 1.1 clause 5.13. This
 * format is also read from non-OHCI controllers. * @local_time contains the
 * system time in microseconds since the Epoch, read at the moment when the
 * cycle timer was read.
 *
 * Return value: 0 for success or error number otherwise.
 */
int hpsb_read_cycle_timer(struct hpsb_host *host, u32 *cycle_timer,
			  u64 *local_time)
{
	int ctr;
	struct timeval tv;
	unsigned long flags;

	if (!host || !cycle_timer || !local_time)
		return -EINVAL;

	preempt_disable();
	local_irq_save(flags);

	ctr = host->driver->devctl(host, GET_CYCLE_COUNTER, 0);
	if (ctr)
		do_gettimeofday(&tv);

	local_irq_restore(flags);
	preempt_enable();

	if (!ctr)
		return -EIO;
	*cycle_timer = ctr;
	*local_time = tv.tv_sec * 1000000ULL + tv.tv_usec;
	return 0;
}
Linus Torvalds's avatar
Linus Torvalds committed
231

232 233 234 235 236 237 238 239
/**
 * hpsb_bus_reset - notify a bus reset to the core
 *
 * For host driver module usage.  Safe to use in interrupt context, although
 * quite complex; so you may want to run it in the bottom rather than top half.
 *
 * Returns 1 if bus reset already in progress, 0 otherwise.
 */
Linus Torvalds's avatar
Linus Torvalds committed
240 241
int hpsb_bus_reset(struct hpsb_host *host)
{
242 243
	if (host->in_bus_reset) {
		HPSB_NOTICE("%s called while bus reset already in progress",
Linus Torvalds's avatar
Linus Torvalds committed
244
			    __FUNCTION__);
245 246
		return 1;
	}
Linus Torvalds's avatar
Linus Torvalds committed
247

248 249 250
	abort_requests(host);
	host->in_bus_reset = 1;
	host->irm_id = -1;
Linus Torvalds's avatar
Linus Torvalds committed
251
	host->is_irm = 0;
252
	host->busmgr_id = -1;
Linus Torvalds's avatar
Linus Torvalds committed
253 254
	host->is_busmgr = 0;
	host->is_cycmst = 0;
255 256
	host->node_count = 0;
	host->selfid_count = 0;
Linus Torvalds's avatar
Linus Torvalds committed
257

258
	return 0;
Linus Torvalds's avatar
Linus Torvalds committed
259 260 261 262 263 264 265 266 267
}


/*
 * Verify num_of_selfids SelfIDs and return number of nodes.  Return zero in
 * case verification failed.
 */
static int check_selfids(struct hpsb_host *host)
{
268 269 270 271 272
	int nodeid = -1;
	int rest_of_selfids = host->selfid_count;
	struct selfid *sid = (struct selfid *)host->topology_map;
	struct ext_selfid *esid;
	int esid_seq = 23;
Linus Torvalds's avatar
Linus Torvalds committed
273 274 275

	host->nodes_active = 0;

276 277 278 279
	while (rest_of_selfids--) {
		if (!sid->extended) {
			nodeid++;
			esid_seq = 0;
Linus Torvalds's avatar
Linus Torvalds committed
280

281 282 283 284 285
			if (sid->phy_id != nodeid) {
				HPSB_INFO("SelfIDs failed monotony check with "
					  "%d", sid->phy_id);
				return 0;
			}
Linus Torvalds's avatar
Linus Torvalds committed
286 287 288 289 290 291

			if (sid->link_active) {
				host->nodes_active++;
				if (sid->contender)
					host->irm_id = LOCAL_BUS | sid->phy_id;
			}
292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308
		} else {
			esid = (struct ext_selfid *)sid;

			if ((esid->phy_id != nodeid)
			    || (esid->seq_nr != esid_seq)) {
				HPSB_INFO("SelfIDs failed monotony check with "
					  "%d/%d", esid->phy_id, esid->seq_nr);
				return 0;
			}
			esid_seq++;
		}
		sid++;
	}

	esid = (struct ext_selfid *)(sid - 1);
	while (esid->extended) {
		if ((esid->porta == SELFID_PORT_PARENT) ||
309 310 311 312 313 314 315
		    (esid->portb == SELFID_PORT_PARENT) ||
		    (esid->portc == SELFID_PORT_PARENT) ||
		    (esid->portd == SELFID_PORT_PARENT) ||
		    (esid->porte == SELFID_PORT_PARENT) ||
		    (esid->portf == SELFID_PORT_PARENT) ||
		    (esid->portg == SELFID_PORT_PARENT) ||
		    (esid->porth == SELFID_PORT_PARENT)) {
Linus Torvalds's avatar
Linus Torvalds committed
316 317 318
			HPSB_INFO("SelfIDs failed root check on "
				  "extended SelfID");
			return 0;
319 320 321
		}
		esid--;
	}
Linus Torvalds's avatar
Linus Torvalds committed
322

323
	sid = (struct selfid *)esid;
324 325 326
	if ((sid->port0 == SELFID_PORT_PARENT) ||
	    (sid->port1 == SELFID_PORT_PARENT) ||
	    (sid->port2 == SELFID_PORT_PARENT)) {
Linus Torvalds's avatar
Linus Torvalds committed
327 328
		HPSB_INFO("SelfIDs failed root check");
		return 0;
329
	}
Linus Torvalds's avatar
Linus Torvalds committed
330 331

	host->node_count = nodeid + 1;
332
	return 1;
Linus Torvalds's avatar
Linus Torvalds committed
333 334 335 336 337
}

static void build_speed_map(struct hpsb_host *host, int nodecount)
{
	u8 cldcnt[nodecount];
338
	u8 *map = host->speed_map;
339
	u8 *speedcap = host->speed;
340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359
	struct selfid *sid;
	struct ext_selfid *esid;
	int i, j, n;

	for (i = 0; i < (nodecount * 64); i += 64) {
		for (j = 0; j < nodecount; j++) {
			map[i+j] = IEEE1394_SPEED_MAX;
		}
	}

	for (i = 0; i < nodecount; i++) {
		cldcnt[i] = 0;
	}

	/* find direct children count and speed */
	for (sid = (struct selfid *)&host->topology_map[host->selfid_count-1],
		     n = nodecount - 1;
	     (void *)sid >= (void *)host->topology_map; sid--) {
		if (sid->extended) {
			esid = (struct ext_selfid *)sid;
Linus Torvalds's avatar
Linus Torvalds committed
360

361 362 363 364 365 366 367 368
			if (esid->porta == SELFID_PORT_CHILD) cldcnt[n]++;
			if (esid->portb == SELFID_PORT_CHILD) cldcnt[n]++;
			if (esid->portc == SELFID_PORT_CHILD) cldcnt[n]++;
			if (esid->portd == SELFID_PORT_CHILD) cldcnt[n]++;
			if (esid->porte == SELFID_PORT_CHILD) cldcnt[n]++;
			if (esid->portf == SELFID_PORT_CHILD) cldcnt[n]++;
			if (esid->portg == SELFID_PORT_CHILD) cldcnt[n]++;
			if (esid->porth == SELFID_PORT_CHILD) cldcnt[n]++;
Linus Torvalds's avatar
Linus Torvalds committed
369
                } else {
370 371 372
			if (sid->port0 == SELFID_PORT_CHILD) cldcnt[n]++;
			if (sid->port1 == SELFID_PORT_CHILD) cldcnt[n]++;
			if (sid->port2 == SELFID_PORT_CHILD) cldcnt[n]++;
Linus Torvalds's avatar
Linus Torvalds committed
373

374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405
			speedcap[n] = sid->speed;
			n--;
		}
	}

	/* set self mapping */
	for (i = 0; i < nodecount; i++) {
		map[64*i + i] = speedcap[i];
	}

	/* fix up direct children count to total children count;
	 * also fix up speedcaps for sibling and parent communication */
	for (i = 1; i < nodecount; i++) {
		for (j = cldcnt[i], n = i - 1; j > 0; j--) {
			cldcnt[i] += cldcnt[n];
			speedcap[n] = min(speedcap[n], speedcap[i]);
			n -= cldcnt[n] + 1;
		}
	}

	for (n = 0; n < nodecount; n++) {
		for (i = n - cldcnt[n]; i <= n; i++) {
			for (j = 0; j < (n - cldcnt[n]); j++) {
				map[j*64 + i] = map[i*64 + j] =
					min(map[i*64 + j], speedcap[n]);
			}
			for (j = n + 1; j < nodecount; j++) {
				map[j*64 + i] = map[i*64 + j] =
					min(map[i*64 + j], speedcap[n]);
			}
		}
	}
406

407
#if SELFID_SPEED_UNKNOWN != IEEE1394_SPEED_MAX
408 409
	/* assume maximum speed for 1394b PHYs, nodemgr will correct it */
	for (n = 0; n < nodecount; n++)
410
		if (speedcap[n] == SELFID_SPEED_UNKNOWN)
411
			speedcap[n] = IEEE1394_SPEED_MAX;
412
#endif
Linus Torvalds's avatar
Linus Torvalds committed
413 414 415
}


416 417 418 419 420 421 422 423
/**
 * hpsb_selfid_received - hand over received selfid packet to the core
 *
 * For host driver module usage.  Safe to use in interrupt context.
 *
 * The host driver should have done a successful complement check (second
 * quadlet is complement of first) beforehand.
 */
Linus Torvalds's avatar
Linus Torvalds committed
424 425
void hpsb_selfid_received(struct hpsb_host *host, quadlet_t sid)
{
426 427 428 429 430
	if (host->in_bus_reset) {
		HPSB_VERBOSE("Including SelfID 0x%x", sid);
		host->topology_map[host->selfid_count++] = sid;
	} else {
		HPSB_NOTICE("Spurious SelfID packet (0x%08x) received from bus %d",
Linus Torvalds's avatar
Linus Torvalds committed
431
			    sid, NODEID_TO_BUS(host->node_id));
432
	}
Linus Torvalds's avatar
Linus Torvalds committed
433 434
}

435 436 437 438 439 440 441 442 443
/**
 * hpsb_selfid_complete - notify completion of SelfID stage to the core
 *
 * For host driver module usage.  Safe to use in interrupt context, although
 * quite complex; so you may want to run it in the bottom rather than top half.
 *
 * Notify completion of SelfID stage to the core and report new physical ID
 * and whether host is root now.
 */
Linus Torvalds's avatar
Linus Torvalds committed
444 445 446 447 448
void hpsb_selfid_complete(struct hpsb_host *host, int phyid, int isroot)
{
	if (!host->in_bus_reset)
		HPSB_NOTICE("SelfID completion called outside of bus reset!");

449 450
	host->node_id = LOCAL_BUS | phyid;
	host->is_root = isroot;
Linus Torvalds's avatar
Linus Torvalds committed
451

452 453 454 455
	if (!check_selfids(host)) {
		if (host->reset_retries++ < 20) {
			/* selfid stage did not complete without error */
			HPSB_NOTICE("Error in SelfID stage, resetting");
Linus Torvalds's avatar
Linus Torvalds committed
456 457
			host->in_bus_reset = 0;
			/* this should work from ohci1394 now... */
458 459 460 461 462
			hpsb_reset_bus(host, LONG_RESET);
			return;
		} else {
			HPSB_NOTICE("Stopping out-of-control reset loop");
			HPSB_NOTICE("Warning - topology map and speed map will not be valid");
Linus Torvalds's avatar
Linus Torvalds committed
463
			host->reset_retries = 0;
464 465
		}
	} else {
Linus Torvalds's avatar
Linus Torvalds committed
466
		host->reset_retries = 0;
467 468
		build_speed_map(host, host->node_count);
	}
Linus Torvalds's avatar
Linus Torvalds committed
469 470 471 472

	HPSB_VERBOSE("selfid_complete called with successful SelfID stage "
		     "... irm_id: 0x%X node_id: 0x%X",host->irm_id,host->node_id);

473 474 475 476 477 478 479
	/* irm_id is kept up to date by check_selfids() */
	if (host->irm_id == host->node_id) {
		host->is_irm = 1;
	} else {
		host->is_busmgr = 0;
		host->is_irm = 0;
	}
Linus Torvalds's avatar
Linus Torvalds committed
480

481
	if (isroot) {
Linus Torvalds's avatar
Linus Torvalds committed
482 483 484 485 486
		host->driver->devctl(host, ACT_CYCLE_MASTER, 1);
		host->is_cycmst = 1;
	}
	atomic_inc(&host->generation);
	host->in_bus_reset = 0;
487
	highlevel_host_reset(host);
Linus Torvalds's avatar
Linus Torvalds committed
488 489
}

490 491
static spinlock_t pending_packets_lock = SPIN_LOCK_UNLOCKED;

492 493 494 495 496 497 498 499 500 501
/**
 * hpsb_packet_sent - notify core of sending a packet
 *
 * For host driver module usage.  Safe to call from within a transmit packet
 * routine.
 *
 * Notify core of sending a packet.  Ackcode is the ack code returned for async
 * transmits or ACKX_SEND_ERROR if the transmission failed completely; ACKX_NONE
 * for other cases (internal errors that don't justify a panic).
 */
Linus Torvalds's avatar
Linus Torvalds committed
502
void hpsb_packet_sent(struct hpsb_host *host, struct hpsb_packet *packet,
503
		      int ackcode)
Linus Torvalds's avatar
Linus Torvalds committed
504 505 506
{
	unsigned long flags;

507
	spin_lock_irqsave(&pending_packets_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
508 509 510 511 512

	packet->ack_code = ackcode;

	if (packet->no_waiter || packet->state == hpsb_complete) {
		/* if packet->no_waiter, must not have a tlabel allocated */
513
		spin_unlock_irqrestore(&pending_packets_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
514 515 516 517 518
		hpsb_free_packet(packet);
		return;
	}

	atomic_dec(&packet->refcnt);	/* drop HC's reference */
519
	/* here the packet must be on the host->pending_packets queue */
Linus Torvalds's avatar
Linus Torvalds committed
520 521 522

	if (ackcode != ACK_PENDING || !packet->expect_response) {
		packet->state = hpsb_complete;
523 524
		list_del_init(&packet->queue);
		spin_unlock_irqrestore(&pending_packets_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
525 526 527 528 529 530 531
		queue_packet_complete(packet);
		return;
	}

	packet->state = hpsb_pending;
	packet->sendtime = jiffies;

532
	spin_unlock_irqrestore(&pending_packets_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
533 534 535 536 537 538 539 540 541 542

	mod_timer(&host->timeout, jiffies + host->timeout_interval);
}

/**
 * hpsb_send_phy_config - transmit a PHY configuration packet on the bus
 * @host: host that PHY config packet gets sent through
 * @rootid: root whose force_root bit should get set (-1 = don't set force_root)
 * @gapcnt: gap count value to set (-1 = don't set gap count)
 *
543 544
 * This function sends a PHY config packet on the bus through the specified
 * host.
Linus Torvalds's avatar
Linus Torvalds committed
545
 *
546
 * Return value: 0 for success or negative error number otherwise.
Linus Torvalds's avatar
Linus Torvalds committed
547 548 549 550
 */
int hpsb_send_phy_config(struct hpsb_host *host, int rootid, int gapcnt)
{
	struct hpsb_packet *packet;
551
	quadlet_t d = 0;
Linus Torvalds's avatar
Linus Torvalds committed
552 553 554 555 556 557 558 559 560 561
	int retval = 0;

	if (rootid >= ALL_NODES || rootid < -1 || gapcnt > 0x3f || gapcnt < -1 ||
	   (rootid == -1 && gapcnt == -1)) {
		HPSB_DEBUG("Invalid Parameter: rootid = %d   gapcnt = %d",
			   rootid, gapcnt);
		return -EINVAL;
	}

	if (rootid != -1)
562
		d |= PHYPACKET_PHYCONFIG_R | rootid << PHYPACKET_PORT_SHIFT;
Linus Torvalds's avatar
Linus Torvalds committed
563
	if (gapcnt != -1)
564
		d |= PHYPACKET_PHYCONFIG_T | gapcnt << PHYPACKET_GAPCOUNT_SHIFT;
Linus Torvalds's avatar
Linus Torvalds committed
565

566 567 568
	packet = hpsb_make_phypacket(host, d);
	if (!packet)
		return -ENOMEM;
Linus Torvalds's avatar
Linus Torvalds committed
569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594

	packet->generation = get_hpsb_generation(host);
	retval = hpsb_send_packet_and_wait(packet);
	hpsb_free_packet(packet);

	return retval;
}

/**
 * hpsb_send_packet - transmit a packet on the bus
 * @packet: packet to send
 *
 * The packet is sent through the host specified in the packet->host field.
 * Before sending, the packet's transmit speed is automatically determined
 * using the local speed map when it is an async, non-broadcast packet.
 *
 * Possibilities for failure are that host is either not initialized, in bus
 * reset, the packet's generation number doesn't match the current generation
 * number or the host reports a transmit error.
 *
 * Return value: 0 on success, negative errno on failure.
 */
int hpsb_send_packet(struct hpsb_packet *packet)
{
	struct hpsb_host *host = packet->host;

595
	if (host->is_shutdown)
Linus Torvalds's avatar
Linus Torvalds committed
596 597 598
		return -EINVAL;
	if (host->in_bus_reset ||
	    (packet->generation != get_hpsb_generation(host)))
599
		return -EAGAIN;
Linus Torvalds's avatar
Linus Torvalds committed
600

601
	packet->state = hpsb_queued;
Linus Torvalds's avatar
Linus Torvalds committed
602 603 604 605 606

	/* This just seems silly to me */
	WARN_ON(packet->no_waiter && packet->expect_response);

	if (!packet->no_waiter || packet->expect_response) {
607 608
		unsigned long flags;

Linus Torvalds's avatar
Linus Torvalds committed
609
		atomic_inc(&packet->refcnt);
Ben Collins's avatar
Ben Collins committed
610 611 612
		/* Set the initial "sendtime" to 10 seconds from now, to
		   prevent premature expiry.  If a packet takes more than
		   10 seconds to hit the wire, we have bigger problems :) */
613
		packet->sendtime = jiffies + 10 * HZ;
614 615 616
		spin_lock_irqsave(&pending_packets_lock, flags);
		list_add_tail(&packet->queue, &host->pending_packets);
		spin_unlock_irqrestore(&pending_packets_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
617 618
	}

619
	if (packet->node_id == host->node_id) {
Linus Torvalds's avatar
Linus Torvalds committed
620 621
		/* it is a local request, so handle it locally */

622 623
		quadlet_t *data;
		size_t size = packet->data_size + packet->header_size;
Linus Torvalds's avatar
Linus Torvalds committed
624

625 626 627 628 629
		data = kmalloc(size, GFP_ATOMIC);
		if (!data) {
			HPSB_ERR("unable to allocate memory for concatenating header and data");
			return -ENOMEM;
		}
Linus Torvalds's avatar
Linus Torvalds committed
630

631
		memcpy(data, packet->header, packet->header_size);
Linus Torvalds's avatar
Linus Torvalds committed
632

633
		if (packet->data_size)
Linus Torvalds's avatar
Linus Torvalds committed
634 635
			memcpy(((u8*)data) + packet->header_size, packet->data, packet->data_size);

636
		dump_packet("send packet local", packet->header, packet->header_size, -1);
Linus Torvalds's avatar
Linus Torvalds committed
637

638 639
		hpsb_packet_sent(host, packet, packet->expect_response ? ACK_PENDING : ACK_COMPLETE);
		hpsb_packet_received(host, data, size, 0);
Linus Torvalds's avatar
Linus Torvalds committed
640

641
		kfree(data);
Linus Torvalds's avatar
Linus Torvalds committed
642

643 644
		return 0;
	}
Linus Torvalds's avatar
Linus Torvalds committed
645

646 647
	if (packet->type == hpsb_async &&
	    NODEID_TO_NODE(packet->node_id) != ALL_NODES)
648
		packet->speed_code =
649
			host->speed[NODEID_TO_NODE(packet->node_id)];
Linus Torvalds's avatar
Linus Torvalds committed
650

651
	dump_packet("send packet", packet->header, packet->header_size, packet->speed_code);
Linus Torvalds's avatar
Linus Torvalds committed
652

653
	return host->driver->transmit_packet(host, packet);
Linus Torvalds's avatar
Linus Torvalds committed
654 655 656 657 658 659 660 661 662 663 664
}

/* We could just use complete() directly as the packet complete
 * callback, but this is more typesafe, in the sense that we get a
 * compiler error if the prototype for complete() changes. */

static void complete_packet(void *data)
{
	complete((struct completion *) data);
}

665 666 667 668 669 670
/**
 * hpsb_send_packet_and_wait - enqueue packet, block until transaction completes
 * @packet: packet to send
 *
 * Return value: 0 on success, negative errno on failure.
 */
Linus Torvalds's avatar
Linus Torvalds committed
671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686
int hpsb_send_packet_and_wait(struct hpsb_packet *packet)
{
	struct completion done;
	int retval;

	init_completion(&done);
	hpsb_set_packet_complete_task(packet, complete_packet, &done);
	retval = hpsb_send_packet(packet);
	if (retval == 0)
		wait_for_completion(&done);

	return retval;
}

static void send_packet_nocare(struct hpsb_packet *packet)
{
687 688 689
	if (hpsb_send_packet(packet) < 0) {
		hpsb_free_packet(packet);
	}
Linus Torvalds's avatar
Linus Torvalds committed
690 691
}

692 693 694 695 696 697 698 699 700
static size_t packet_size_to_data_size(size_t packet_size, size_t header_size,
				       size_t buffer_size, int tcode)
{
	size_t ret = packet_size <= header_size ? 0 : packet_size - header_size;

	if (unlikely(ret > buffer_size))
		ret = buffer_size;

	if (unlikely(ret + header_size != packet_size))
701
		HPSB_ERR("unexpected packet size %zd (tcode %d), bug?",
702 703 704
			 packet_size, tcode);
	return ret;
}
Linus Torvalds's avatar
Linus Torvalds committed
705 706 707 708

static void handle_packet_response(struct hpsb_host *host, int tcode,
				   quadlet_t *data, size_t size)
{
709 710 711
	struct hpsb_packet *packet;
	int tlabel = (data[0] >> 10) & 0x3f;
	size_t header_size;
712
	unsigned long flags;
Linus Torvalds's avatar
Linus Torvalds committed
713

714
	spin_lock_irqsave(&pending_packets_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
715

716 717 718 719
	list_for_each_entry(packet, &host->pending_packets, queue)
		if (packet->tlabel == tlabel &&
		    packet->node_id == (data[1] >> 16))
			goto found;
Linus Torvalds's avatar
Linus Torvalds committed
720

721 722 723 724 725
	spin_unlock_irqrestore(&pending_packets_lock, flags);
	HPSB_DEBUG("unsolicited response packet received - %s",
		   "no tlabel match");
	dump_packet("contents", data, 16, -1);
	return;
Linus Torvalds's avatar
Linus Torvalds committed
726

727
found:
728 729 730
	switch (packet->tcode) {
	case TCODE_WRITEQ:
	case TCODE_WRITEB:
731
		if (unlikely(tcode != TCODE_WRITE_RESPONSE))
Linus Torvalds's avatar
Linus Torvalds committed
732
			break;
733 734 735 736
		header_size = 12;
		size = 0;
		goto dequeue;

737
	case TCODE_READQ:
738
		if (unlikely(tcode != TCODE_READQ_RESPONSE))
Linus Torvalds's avatar
Linus Torvalds committed
739
			break;
740 741 742 743
		header_size = 16;
		size = 0;
		goto dequeue;

744
	case TCODE_READB:
745
		if (unlikely(tcode != TCODE_READB_RESPONSE))
Linus Torvalds's avatar
Linus Torvalds committed
746
			break;
747 748 749 750 751 752
		header_size = 16;
		size = packet_size_to_data_size(size, header_size,
						packet->allocated_data_size,
						tcode);
		goto dequeue;

753
	case TCODE_LOCK_REQUEST:
754
		if (unlikely(tcode != TCODE_LOCK_RESPONSE))
Linus Torvalds's avatar
Linus Torvalds committed
755
			break;
756 757 758 759 760 761
		header_size = 16;
		size = packet_size_to_data_size(min(size, (size_t)(16 + 8)),
						header_size,
						packet->allocated_data_size,
						tcode);
		goto dequeue;
762
	}
Linus Torvalds's avatar
Linus Torvalds committed
763

764 765 766 767 768
	spin_unlock_irqrestore(&pending_packets_lock, flags);
	HPSB_DEBUG("unsolicited response packet received - %s",
		   "tcode mismatch");
	dump_packet("contents", data, 16, -1);
	return;
Linus Torvalds's avatar
Linus Torvalds committed
769

770 771 772
dequeue:
	list_del_init(&packet->queue);
	spin_unlock_irqrestore(&pending_packets_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
773 774 775 776 777 778

	if (packet->state == hpsb_queued) {
		packet->sendtime = jiffies;
		packet->ack_code = ACK_PENDING;
	}
	packet->state = hpsb_complete;
779 780 781 782

	memcpy(packet->header, data, header_size);
	if (size)
		memcpy(packet->data, data + 4, size);
Linus Torvalds's avatar
Linus Torvalds committed
783 784 785 786 787 788 789 790

	queue_packet_complete(packet);
}


static struct hpsb_packet *create_reply_packet(struct hpsb_host *host,
					       quadlet_t *data, size_t dsize)
{
791
	struct hpsb_packet *p;
Linus Torvalds's avatar
Linus Torvalds committed
792

793 794 795
	p = hpsb_alloc_packet(dsize);
	if (unlikely(p == NULL)) {
		/* FIXME - send data_error response */
796
		HPSB_ERR("out of memory, cannot send response packet");
797 798
		return NULL;
	}
Linus Torvalds's avatar
Linus Torvalds committed
799

800 801 802 803 804 805
	p->type = hpsb_async;
	p->state = hpsb_unused;
	p->host = host;
	p->node_id = data[1] >> 16;
	p->tlabel = (data[0] >> 10) & 0x3f;
	p->no_waiter = 1;
Linus Torvalds's avatar
Linus Torvalds committed
806 807 808 809 810 811

	p->generation = get_hpsb_generation(host);

	if (dsize % 4)
		p->data[dsize / 4] = 0;

812
	return p;
Linus Torvalds's avatar
Linus Torvalds committed
813 814 815 816 817 818 819 820 821 822
}

#define PREP_ASYNC_HEAD_RCODE(tc) \
	packet->tcode = tc; \
	packet->header[0] = (packet->node_id << 16) | (packet->tlabel << 10) \
		| (1 << 8) | (tc << 4); \
	packet->header[1] = (packet->host->node_id << 16) | (rcode << 12); \
	packet->header[2] = 0

static void fill_async_readquad_resp(struct hpsb_packet *packet, int rcode,
823
			      quadlet_t data)
Linus Torvalds's avatar
Linus Torvalds committed
824 825 826 827 828 829 830 831
{
	PREP_ASYNC_HEAD_RCODE(TCODE_READQ_RESPONSE);
	packet->header[3] = data;
	packet->header_size = 16;
	packet->data_size = 0;
}

static void fill_async_readblock_resp(struct hpsb_packet *packet, int rcode,
832
			       int length)
Linus Torvalds's avatar
Linus Torvalds committed
833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850
{
	if (rcode != RCODE_COMPLETE)
		length = 0;

	PREP_ASYNC_HEAD_RCODE(TCODE_READB_RESPONSE);
	packet->header[3] = length << 16;
	packet->header_size = 16;
	packet->data_size = length + (length % 4 ? 4 - (length % 4) : 0);
}

static void fill_async_write_resp(struct hpsb_packet *packet, int rcode)
{
	PREP_ASYNC_HEAD_RCODE(TCODE_WRITE_RESPONSE);
	packet->header_size = 12;
	packet->data_size = 0;
}

static void fill_async_lock_resp(struct hpsb_packet *packet, int rcode, int extcode,
851
			  int length)
Linus Torvalds's avatar
Linus Torvalds committed
852 853 854 855 856 857 858 859 860 861 862
{
	if (rcode != RCODE_COMPLETE)
		length = 0;

	PREP_ASYNC_HEAD_RCODE(TCODE_LOCK_RESPONSE);
	packet->header[3] = (length << 16) | extcode;
	packet->header_size = 16;
	packet->data_size = length;
}

static void handle_incoming_packet(struct hpsb_host *host, int tcode,
863 864
				   quadlet_t *data, size_t size,
				   int write_acked)
Linus Torvalds's avatar
Linus Torvalds committed
865
{
866 867 868 869 870 871 872 873
	struct hpsb_packet *packet;
	int length, rcode, extcode;
	quadlet_t buffer;
	nodeid_t source = data[1] >> 16;
	nodeid_t dest = data[0] >> 16;
	u16 flags = (u16) data[0];
	u64 addr;

874 875
	/* FIXME?
	 * Out-of-bounds lengths are left for highlevel_read|write to cap. */
876 877 878 879

	switch (tcode) {
	case TCODE_WRITEQ:
		addr = (((u64)(data[1] & 0xffff)) << 32) | data[2];
880
		rcode = highlevel_write(host, source, dest, data + 3,
Linus Torvalds's avatar
Linus Torvalds committed
881
					addr, 4, flags);
882
		goto handle_write_request;
883 884 885

	case TCODE_WRITEB:
		addr = (((u64)(data[1] & 0xffff)) << 32) | data[2];
886 887 888 889 890 891 892 893 894
		rcode = highlevel_write(host, source, dest, data + 4,
					addr, data[3] >> 16, flags);
handle_write_request:
		if (rcode < 0 || write_acked ||
		    NODEID_TO_NODE(data[0] >> 16) == NODE_MASK)
			return;
		/* not a broadcast write, reply */
		packet = create_reply_packet(host, data, 0);
		if (packet) {
895 896 897
			fill_async_write_resp(packet, rcode);
			send_packet_nocare(packet);
		}
898
		return;
899 900 901 902

	case TCODE_READQ:
		addr = (((u64)(data[1] & 0xffff)) << 32) | data[2];
		rcode = highlevel_read(host, source, &buffer, addr, 4, flags);
903 904
		if (rcode < 0)
			return;
905

906 907
		packet = create_reply_packet(host, data, 0);
		if (packet) {
908 909 910
			fill_async_readquad_resp(packet, rcode, buffer);
			send_packet_nocare(packet);
		}
911
		return;
912 913 914

	case TCODE_READB:
		length = data[3] >> 16;
915 916 917
		packet = create_reply_packet(host, data, length);
		if (!packet)
			return;
918 919 920 921

		addr = (((u64)(data[1] & 0xffff)) << 32) | data[2];
		rcode = highlevel_read(host, source, packet->data, addr,
				       length, flags);
922
		if (rcode < 0) {
923
			hpsb_free_packet(packet);
924
			return;
925
		}
926 927 928
		fill_async_readblock_resp(packet, rcode, length);
		send_packet_nocare(packet);
		return;
929 930 931 932 933 934

	case TCODE_LOCK_REQUEST:
		length = data[3] >> 16;
		extcode = data[3] & 0xffff;
		addr = (((u64)(data[1] & 0xffff)) << 32) | data[2];

935 936 937
		packet = create_reply_packet(host, data, 8);
		if (!packet)
			return;
938

939
		if (extcode == 0 || extcode >= 7) {
940 941 942 943 944 945 946
			/* let switch default handle error */
			length = 0;
		}

		switch (length) {
		case 4:
			rcode = highlevel_lock(host, source, packet->data, addr,
947
					       data[4], 0, extcode, flags);
948 949 950
			fill_async_lock_resp(packet, rcode, extcode, 4);
			break;
		case 8:
951 952
			if (extcode != EXTCODE_FETCH_ADD &&
			    extcode != EXTCODE_LITTLE_ADD) {
953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975
				rcode = highlevel_lock(host, source,
						       packet->data, addr,
						       data[5], data[4],
						       extcode, flags);
				fill_async_lock_resp(packet, rcode, extcode, 4);
			} else {
				rcode = highlevel_lock64(host, source,
					     (octlet_t *)packet->data, addr,
					     *(octlet_t *)(data + 4), 0ULL,
					     extcode, flags);
				fill_async_lock_resp(packet, rcode, extcode, 8);
			}
			break;
		case 16:
			rcode = highlevel_lock64(host, source,
						 (octlet_t *)packet->data, addr,
						 *(octlet_t *)(data + 6),
						 *(octlet_t *)(data + 4),
						 extcode, flags);
			fill_async_lock_resp(packet, rcode, extcode, 8);
			break;
		default:
			rcode = RCODE_TYPE_ERROR;
976
			fill_async_lock_resp(packet, rcode, extcode, 0);
977 978
		}

979
		if (rcode < 0)
980
			hpsb_free_packet(packet);
981 982 983
		else
			send_packet_nocare(packet);
		return;
984
	}
Linus Torvalds's avatar
Linus Torvalds committed
985 986
}

987 988 989 990 991 992 993 994 995 996 997 998 999 1000
/**
 * hpsb_packet_received - hand over received packet to the core
 *
 * For host driver module usage.
 *
 * The contents of data are expected to be the full packet but with the CRCs
 * left out (data block follows header immediately), with the header (i.e. the
 * first four quadlets) in machine byte order and the data block in big endian.
 * *@data can be safely overwritten after this call.
 *
 * If the packet is a write request, @write_acked is to be set to true if it was
 * ack_complete'd already, false otherwise.  This argument is ignored for any
 * other packet type.
 */
Linus Torvalds's avatar
Linus Torvalds committed
1001
void hpsb_packet_received(struct hpsb_host *host, quadlet_t *data, size_t size,
1002
			  int write_acked)
Linus Torvalds's avatar
Linus Torvalds committed
1003
{
1004 1005
	int tcode;

1006 1007
	if (unlikely(host->in_bus_reset)) {
		HPSB_DEBUG("received packet during reset; ignoring");
1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035
		return;
	}

	dump_packet("received packet", data, size, -1);

	tcode = (data[0] >> 4) & 0xf;

	switch (tcode) {
	case TCODE_WRITE_RESPONSE:
	case TCODE_READQ_RESPONSE:
	case TCODE_READB_RESPONSE:
	case TCODE_LOCK_RESPONSE:
		handle_packet_response(host, tcode, data, size);
		break;

	case TCODE_WRITEQ:
	case TCODE_WRITEB:
	case TCODE_READQ:
	case TCODE_READB:
	case TCODE_LOCK_REQUEST:
		handle_incoming_packet(host, tcode, data, size, write_acked);
		break;

	case TCODE_CYCLE_START:
		/* simply ignore this packet if it is passed on */
		break;

	default:
1036 1037
		HPSB_DEBUG("received packet with bogus transaction code %d",
			   tcode);
1038 1039
		break;
	}
Linus Torvalds's avatar
Linus Torvalds committed
1040 1041 1042 1043
}

static void abort_requests(struct hpsb_host *host)
{
1044 1045 1046
	struct hpsb_packet *packet, *p;
	struct list_head tmp;
	unsigned long flags;
Linus Torvalds's avatar
Linus Torvalds committed
1047 1048 1049

	host->driver->devctl(host, CANCEL_REQUESTS, 0);

1050 1051 1052 1053
	INIT_LIST_HEAD(&tmp);
	spin_lock_irqsave(&pending_packets_lock, flags);
	list_splice_init(&host->pending_packets, &tmp);
	spin_unlock_irqrestore(&pending_packets_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
1054

1055 1056
	list_for_each_entry_safe(packet, p, &tmp, queue) {
		list_del_init(&packet->queue);
Linus Torvalds's avatar
Linus Torvalds committed
1057 1058 1059 1060 1061 1062 1063 1064 1065
		packet->state = hpsb_complete;
		packet->ack_code = ACKX_ABORTED;
		queue_packet_complete(packet);
	}
}

void abort_timedouts(unsigned long __opaque)
{
	struct hpsb_host *host = (struct hpsb_host *)__opaque;
1066 1067 1068
	struct hpsb_packet *packet, *p;
	struct list_head tmp;
	unsigned long flags, expire, j;
Linus Torvalds's avatar
Linus Torvalds committed
1069 1070 1071 1072 1073

	spin_lock_irqsave(&host->csr.lock, flags);
	expire = host->csr.expire;
	spin_unlock_irqrestore(&host->csr.lock, flags);

1074 1075 1076
	j = jiffies;
	INIT_LIST_HEAD(&tmp);
	spin_lock_irqsave(&pending_packets_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
1077

1078 1079 1080 1081
	list_for_each_entry_safe(packet, p, &host->pending_packets, queue) {
		if (time_before(packet->sendtime + expire, j))
			list_move_tail(&packet->queue, &tmp);
		else
Linus Torvalds's avatar
Linus Torvalds committed
1082 1083 1084 1085 1086
			/* Since packets are added to the tail, the oldest
			 * ones are first, always. When we get to one that
			 * isn't timed out, the rest aren't either. */
			break;
	}
1087 1088
	if (!list_empty(&host->pending_packets))
		mod_timer(&host->timeout, j + host->timeout_interval);
Linus Torvalds's avatar
Linus Torvalds committed
1089

1090
	spin_unlock_irqrestore(&pending_packets_lock, flags);
Linus Torvalds's avatar
Linus Torvalds committed
1091

1092 1093 1094 1095 1096 1097
	list_for_each_entry_safe(packet, p, &tmp, queue) {
		list_del_init(&packet->queue);
		packet->state = hpsb_complete;
		packet->ack_code = ACKX_TIMEOUT;
		queue_packet_complete(packet);
	}
Linus Torvalds's avatar
Linus Torvalds committed
1098 1099
}

1100
static struct task_struct *khpsbpkt_thread;
1101
static LIST_HEAD(hpsbpkt_queue);
Linus Torvalds's avatar
Linus Torvalds committed
1102 1103 1104

static void queue_packet_complete(struct hpsb_packet *packet)
{
1105 1106
	unsigned long flags;

Linus Torvalds's avatar
Linus Torvalds committed
1107 1108 1109 1110 1111
	if (packet->no_waiter) {
		hpsb_free_packet(packet);
		return;
	}
	if (packet->complete_routine != NULL) {
1112 1113 1114
		spin_lock_irqsave(&pending_packets_lock, flags);
		list_add_tail(&packet->queue, &hpsbpkt_queue);
		spin_unlock_irqrestore(&pending_packets_lock, flags);
1115
		wake_up_process(khpsbpkt_thread);
Linus Torvalds's avatar
Linus Torvalds committed
1116 1117 1118 1119
	}
	return;
}

1120 1121 1122 1123 1124
/*
 * Kernel thread which handles packets that are completed.  This way the
 * packet's "complete" function is asynchronously run in process context.
 * Only packets which have a "complete" function may be sent here.
 */
Linus Torvalds's avatar
Linus Torvalds committed
1125 1126
static int hpsbpkt_thread(void *__hi)
{
1127 1128 1129
	struct hpsb_packet *packet, *p;
	struct list_head tmp;
	int may_schedule;
Linus Torvalds's avatar
Linus Torvalds committed
1130

1131 1132
	current->flags |= PF_NOFREEZE;

1133
	while (!kthread_should_stop()) {
Linus Torvalds's avatar
Linus Torvalds committed
1134

1135 1136 1137 1138
		INIT_LIST_HEAD(&tmp);
		spin_lock_irq(&pending_packets_lock);
		list_splice_init(&hpsbpkt_queue, &tmp);
		spin_unlock_irq(&pending_packets_lock);
Linus Torvalds's avatar
Linus Torvalds committed
1139

1140 1141 1142
		list_for_each_entry_safe(packet, p, &tmp, queue) {
			list_del_init(&packet->queue);
			packet->complete_routine(packet->complete_data);
Linus Torvalds's avatar
Linus Torvalds committed
1143 1144
		}

1145
		set_current_state(TASK_INTERRUPTIBLE);
1146 1147 1148 1149
		spin_lock_irq(&pending_packets_lock);
		may_schedule = list_empty(&hpsbpkt_queue);
		spin_unlock_irq(&pending_packets_lock);
		if (may_schedule)
1150 1151 1152 1153
			schedule();
		__set_current_state(TASK_RUNNING);
	}
	return 0;
Linus Torvalds's avatar
Linus Torvalds committed
1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165
}

static int __init ieee1394_init(void)
{
	int i, ret;

	/* non-fatal error */
	if (hpsb_init_config_roms()) {
		HPSB_ERR("Failed to initialize some config rom entries.\n");
		HPSB_ERR("Some features may not be available\n");
	}

1166 1167
	khpsbpkt_thread = kthread_run(hpsbpkt_thread, NULL, "khpsbpkt");
	if (IS_ERR(khpsbpkt_thread)) {
Linus Torvalds's avatar
Linus Torvalds committed
1168
		HPSB_ERR("Failed to start hpsbpkt thread!\n");
1169
		ret = PTR_ERR(khpsbpkt_thread);
Linus Torvalds's avatar
Linus Torvalds committed
1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181
		goto exit_cleanup_config_roms;
	}

	if (register_chrdev_region(IEEE1394_CORE_DEV, 256, "ieee1394")) {
		HPSB_ERR("unable to register character device major %d!\n", IEEE1394_MAJOR);
		ret = -ENODEV;
		goto exit_release_kernel_thread;
	}

	ret = bus_register(&ieee1394_bus_type);
	if (ret < 0) {
		HPSB_INFO("bus register failed");
1182
		goto release_chrdev;
Linus Torvalds's avatar
Linus Torvalds committed
1183 1184 1185 1186 1187 1188 1189 1190 1191 1192
	}

	for (i = 0; fw_bus_attrs[i]; i++) {
		ret = bus_create_file(&ieee1394_bus_type, fw_bus_attrs[i]);
		if (ret < 0) {
			while (i >= 0) {
				bus_remove_file(&ieee1394_bus_type,
						fw_bus_attrs[i--]);
			}
			bus_unregister(&ieee1394_bus_type);
1193
			goto release_chrdev;
Linus Torvalds's avatar
Linus Torvalds committed
1194 1195 1196 1197 1198 1199 1200
		}
	}

	ret = class_register(&hpsb_host_class);
	if (ret < 0)
		goto release_all_bus;

1201
	hpsb_protocol_class = class_create(THIS_MODULE, "ieee1394_protocol");
Linus Torvalds's avatar
Linus Torvalds committed
1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219
	if (IS_ERR(hpsb_protocol_class)) {
		ret = PTR_ERR(hpsb_protocol_class);
		goto release_class_host;
	}

	ret = init_csr();
	if (ret) {
		HPSB_INFO("init csr failed");
		ret = -ENOMEM;
		goto release_class_protocol;
	}

	if (disable_nodemgr) {
		HPSB_INFO("nodemgr and IRM functionality disabled");
		/* We shouldn't contend for IRM with nodemgr disabled, since
		   nodemgr implements functionality required of ieee1394a-2000
		   IRMs */
		hpsb_disable_irm = 1;
1220

Linus Torvalds's avatar
Linus Torvalds committed
1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238
		return 0;
	}

	if (hpsb_disable_irm) {
		HPSB_INFO("IRM functionality disabled");
	}

	ret = init_ieee1394_nodemgr();
	if (ret < 0) {
		HPSB_INFO("init nodemgr failed");
		goto cleanup_csr;
	}

	return 0;

cleanup_csr:
	cleanup_csr();
release_class_protocol:
1239
	class_destroy(hpsb_protocol_class);
Linus Torvalds's avatar
Linus Torvalds committed
1240 1241 1242 1243 1244 1245 1246 1247 1248
release_class_host:
	class_unregister(&hpsb_host_class);
release_all_bus:
	for (i = 0; fw_bus_attrs[i]; i++)
		bus_remove_file(&ieee1394_bus_type, fw_bus_attrs[i]);
	bus_unregister(&ieee1394_bus_type);
release_chrdev:
	unregister_chrdev_region(IEEE1394_CORE_DEV, 256);
exit_release_kernel_thread:
1249
	kthread_stop(khpsbpkt_thread);
Linus Torvalds's avatar
Linus Torvalds committed
1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263
exit_cleanup_config_roms:
	hpsb_cleanup_config_roms();
	return ret;
}

static void __exit ieee1394_cleanup(void)
{
	int i;

	if (!disable_nodemgr)
		cleanup_ieee1394_nodemgr();

	cleanup_csr();

1264
	class_destroy(hpsb_protocol_class);
Linus Torvalds's avatar
Linus Torvalds committed
1265 1266 1267 1268 1269
	class_unregister(&hpsb_host_class);
	for (i = 0; fw_bus_attrs[i]; i++)
		bus_remove_file(&ieee1394_bus_type, fw_bus_attrs[i]);
	bus_unregister(&ieee1394_bus_type);

1270
	kthread_stop(khpsbpkt_thread);
Linus Torvalds's avatar
Linus Torvalds committed
1271 1272 1273 1274 1275 1276

	hpsb_cleanup_config_roms();

	unregister_chrdev_region(IEEE1394_CORE_DEV, 256);
}

1277
fs_initcall(ieee1394_init); /* same as ohci1394 */
Linus Torvalds's avatar
Linus Torvalds committed
1278 1279 1280 1281 1282 1283 1284
module_exit(ieee1394_cleanup);

/* Exported symbols */

/** hosts.c **/
EXPORT_SYMBOL(hpsb_alloc_host);
EXPORT_SYMBOL(hpsb_add_host);
1285
EXPORT_SYMBOL(hpsb_resume_host);
Linus Torvalds's avatar
Linus Torvalds committed
1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296
EXPORT_SYMBOL(hpsb_remove_host);
EXPORT_SYMBOL(hpsb_update_config_rom_image);

/** ieee1394_core.c **/
EXPORT_SYMBOL(hpsb_speedto_str);
EXPORT_SYMBOL(hpsb_protocol_class);
EXPORT_SYMBOL(hpsb_set_packet_complete_task);
EXPORT_SYMBOL(hpsb_alloc_packet);
EXPORT_SYMBOL(hpsb_free_packet);
EXPORT_SYMBOL(hpsb_send_packet);
EXPORT_SYMBOL(hpsb_reset_bus);
1297
EXPORT_SYMBOL(hpsb_read_cycle_timer);
Linus Torvalds's avatar
Linus Torvalds committed
1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333
EXPORT_SYMBOL(hpsb_bus_reset);
EXPORT_SYMBOL(hpsb_selfid_received);
EXPORT_SYMBOL(hpsb_selfid_complete);
EXPORT_SYMBOL(hpsb_packet_sent);
EXPORT_SYMBOL(hpsb_packet_received);
EXPORT_SYMBOL_GPL(hpsb_disable_irm);

/** ieee1394_transactions.c **/
EXPORT_SYMBOL(hpsb_get_tlabel);
EXPORT_SYMBOL(hpsb_free_tlabel);
EXPORT_SYMBOL(hpsb_make_readpacket);
EXPORT_SYMBOL(hpsb_make_writepacket);
EXPORT_SYMBOL(hpsb_make_streampacket);
EXPORT_SYMBOL(hpsb_make_lockpacket);
EXPORT_SYMBOL(hpsb_make_lock64packet);
EXPORT_SYMBOL(hpsb_make_phypacket);
EXPORT_SYMBOL(hpsb_read);
EXPORT_SYMBOL(hpsb_write);
EXPORT_SYMBOL(hpsb_packet_success);

/** highlevel.c **/
EXPORT_SYMBOL(hpsb_register_highlevel);
EXPORT_SYMBOL(hpsb_unregister_highlevel);
EXPORT_SYMBOL(hpsb_register_addrspace);
EXPORT_SYMBOL(hpsb_unregister_addrspace);
EXPORT_SYMBOL(hpsb_allocate_and_register_addrspace);
EXPORT_SYMBOL(hpsb_get_hostinfo);
EXPORT_SYMBOL(hpsb_create_hostinfo);
EXPORT_SYMBOL(hpsb_destroy_hostinfo);
EXPORT_SYMBOL(hpsb_set_hostinfo_key);
EXPORT_SYMBOL(hpsb_get_hostinfo_bykey);
EXPORT_SYMBOL(hpsb_set_hostinfo);

/** nodemgr.c **/
EXPORT_SYMBOL(hpsb_node_fill_packet);
EXPORT_SYMBOL(hpsb_node_write);
1334
EXPORT_SYMBOL(__hpsb_register_protocol);
Linus Torvalds's avatar
Linus Torvalds committed
1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373
EXPORT_SYMBOL(hpsb_unregister_protocol);

/** csr.c **/
EXPORT_SYMBOL(hpsb_update_config_rom);

/** dma.c **/
EXPORT_SYMBOL(dma_prog_region_init);
EXPORT_SYMBOL(dma_prog_region_alloc);
EXPORT_SYMBOL(dma_prog_region_free);
EXPORT_SYMBOL(dma_region_init);
EXPORT_SYMBOL(dma_region_alloc);
EXPORT_SYMBOL(dma_region_free);
EXPORT_SYMBOL(dma_region_sync_for_cpu);
EXPORT_SYMBOL(dma_region_sync_for_device);
EXPORT_SYMBOL(dma_region_mmap);
EXPORT_SYMBOL(dma_region_offset_to_bus);

/** iso.c **/
EXPORT_SYMBOL(hpsb_iso_xmit_init);
EXPORT_SYMBOL(hpsb_iso_recv_init);
EXPORT_SYMBOL(hpsb_iso_xmit_start);
EXPORT_SYMBOL(hpsb_iso_recv_start);
EXPORT_SYMBOL(hpsb_iso_recv_listen_channel);
EXPORT_SYMBOL(hpsb_iso_recv_unlisten_channel);
EXPORT_SYMBOL(hpsb_iso_recv_set_channel_mask);
EXPORT_SYMBOL(hpsb_iso_stop);
EXPORT_SYMBOL(hpsb_iso_shutdown);
EXPORT_SYMBOL(hpsb_iso_xmit_queue_packet);
EXPORT_SYMBOL(hpsb_iso_xmit_sync);
EXPORT_SYMBOL(hpsb_iso_recv_release_packets);
EXPORT_SYMBOL(hpsb_iso_n_ready);
EXPORT_SYMBOL(hpsb_iso_packet_sent);
EXPORT_SYMBOL(hpsb_iso_packet_received);
EXPORT_SYMBOL(hpsb_iso_wake);
EXPORT_SYMBOL(hpsb_iso_recv_flush);

/** csr1212.c **/
EXPORT_SYMBOL(csr1212_attach_keyval_to_directory);
EXPORT_SYMBOL(csr1212_detach_keyval_from_directory);
1374 1375
EXPORT_SYMBOL(csr1212_get_keyval);
EXPORT_SYMBOL(csr1212_new_directory);
Linus Torvalds's avatar
Linus Torvalds committed
1376
EXPORT_SYMBOL(csr1212_parse_keyval);
1377 1378
EXPORT_SYMBOL(csr1212_read);
EXPORT_SYMBOL(csr1212_release_keyval);