spi.c 20.4 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
/*
 * spi.c - SPI init/core code
 *
 * Copyright (C) 2005 David Brownell
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

#include <linux/kernel.h>
#include <linux/device.h>
#include <linux/init.h>
#include <linux/cache.h>
25
#include <linux/mutex.h>
26 27 28
#include <linux/spi/spi.h>


29 30 31
/* SPI bustype and spi_master class are registered after board init code
 * provides the SPI device tables, ensuring that both are present by the
 * time controller driver registration causes spi_devices to "enumerate".
32 33 34
 */
static void spidev_release(struct device *dev)
{
35
	struct spi_device	*spi = to_spi_device(dev);
36 37 38 39 40

	/* spi masters may cleanup for released devices */
	if (spi->master->cleanup)
		spi->master->cleanup(spi);

D
David Brownell 已提交
41
	spi_master_put(spi->master);
42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68
	kfree(dev);
}

static ssize_t
modalias_show(struct device *dev, struct device_attribute *a, char *buf)
{
	const struct spi_device	*spi = to_spi_device(dev);

	return snprintf(buf, BUS_ID_SIZE + 1, "%s\n", spi->modalias);
}

static struct device_attribute spi_dev_attrs[] = {
	__ATTR_RO(modalias),
	__ATTR_NULL,
};

/* modalias support makes "modprobe $MODALIAS" new-style hotplug work,
 * and the sysfs version makes coldplug work too.
 */

static int spi_match_device(struct device *dev, struct device_driver *drv)
{
	const struct spi_device	*spi = to_spi_device(dev);

	return strncmp(spi->modalias, drv->name, BUS_ID_SIZE) == 0;
}

69
static int spi_uevent(struct device *dev, struct kobj_uevent_env *env)
70 71 72
{
	const struct spi_device		*spi = to_spi_device(dev);

73
	add_uevent_var(env, "MODALIAS=%s", spi->modalias);
74 75 76 77 78 79 80
	return 0;
}

#ifdef	CONFIG_PM

static int spi_suspend(struct device *dev, pm_message_t message)
{
81
	int			value = 0;
82
	struct spi_driver	*drv = to_spi_driver(dev->driver);
83 84

	/* suspend will stop irqs and dma; no more i/o */
85 86 87 88 89 90
	if (drv) {
		if (drv->suspend)
			value = drv->suspend(to_spi_device(dev), message);
		else
			dev_dbg(dev, "... can't suspend\n");
	}
91 92 93 94 95
	return value;
}

static int spi_resume(struct device *dev)
{
96
	int			value = 0;
97
	struct spi_driver	*drv = to_spi_driver(dev->driver);
98 99

	/* resume may restart the i/o queue */
100 101 102 103 104 105
	if (drv) {
		if (drv->resume)
			value = drv->resume(to_spi_device(dev));
		else
			dev_dbg(dev, "... can't resume\n");
	}
106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123
	return value;
}

#else
#define spi_suspend	NULL
#define spi_resume	NULL
#endif

struct bus_type spi_bus_type = {
	.name		= "spi",
	.dev_attrs	= spi_dev_attrs,
	.match		= spi_match_device,
	.uevent		= spi_uevent,
	.suspend	= spi_suspend,
	.resume		= spi_resume,
};
EXPORT_SYMBOL_GPL(spi_bus_type);

124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145

static int spi_drv_probe(struct device *dev)
{
	const struct spi_driver		*sdrv = to_spi_driver(dev->driver);

	return sdrv->probe(to_spi_device(dev));
}

static int spi_drv_remove(struct device *dev)
{
	const struct spi_driver		*sdrv = to_spi_driver(dev->driver);

	return sdrv->remove(to_spi_device(dev));
}

static void spi_drv_shutdown(struct device *dev)
{
	const struct spi_driver		*sdrv = to_spi_driver(dev->driver);

	sdrv->shutdown(to_spi_device(dev));
}

D
David Brownell 已提交
146 147 148 149 150
/**
 * spi_register_driver - register a SPI driver
 * @sdrv: the driver to register
 * Context: can sleep
 */
151 152 153 154 155 156 157 158 159 160 161 162 163
int spi_register_driver(struct spi_driver *sdrv)
{
	sdrv->driver.bus = &spi_bus_type;
	if (sdrv->probe)
		sdrv->driver.probe = spi_drv_probe;
	if (sdrv->remove)
		sdrv->driver.remove = spi_drv_remove;
	if (sdrv->shutdown)
		sdrv->driver.shutdown = spi_drv_shutdown;
	return driver_register(&sdrv->driver);
}
EXPORT_SYMBOL_GPL(spi_register_driver);

164 165 166 167 168 169 170 171 172 173 174 175 176 177 178
/*-------------------------------------------------------------------------*/

/* SPI devices should normally not be created by SPI device drivers; that
 * would make them board-specific.  Similarly with SPI master drivers.
 * Device registration normally goes into like arch/.../mach.../board-YYY.c
 * with other readonly (flashable) information about mainboard devices.
 */

struct boardinfo {
	struct list_head	list;
	unsigned		n_board_info;
	struct spi_board_info	board_info[0];
};

static LIST_HEAD(board_list);
179
static DEFINE_MUTEX(board_lock);
180

181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228
/**
 * spi_alloc_device - Allocate a new SPI device
 * @master: Controller to which device is connected
 * Context: can sleep
 *
 * Allows a driver to allocate and initialize a spi_device without
 * registering it immediately.  This allows a driver to directly
 * fill the spi_device with device parameters before calling
 * spi_add_device() on it.
 *
 * Caller is responsible to call spi_add_device() on the returned
 * spi_device structure to add it to the SPI master.  If the caller
 * needs to discard the spi_device without adding it, then it should
 * call spi_dev_put() on it.
 *
 * Returns a pointer to the new device, or NULL.
 */
struct spi_device *spi_alloc_device(struct spi_master *master)
{
	struct spi_device	*spi;
	struct device		*dev = master->dev.parent;

	if (!spi_master_get(master))
		return NULL;

	spi = kzalloc(sizeof *spi, GFP_KERNEL);
	if (!spi) {
		dev_err(dev, "cannot alloc spi_device\n");
		spi_master_put(master);
		return NULL;
	}

	spi->master = master;
	spi->dev.parent = dev;
	spi->dev.bus = &spi_bus_type;
	spi->dev.release = spidev_release;
	device_initialize(&spi->dev);
	return spi;
}
EXPORT_SYMBOL_GPL(spi_alloc_device);

/**
 * spi_add_device - Add spi_device allocated with spi_alloc_device
 * @spi: spi_device to register
 *
 * Companion function to spi_alloc_device.  Devices allocated with
 * spi_alloc_device can be added onto the spi bus with this function.
 *
229
 * Returns 0 on success; negative errno on failure
230 231 232
 */
int spi_add_device(struct spi_device *spi)
{
233
	static DEFINE_MUTEX(spi_add_lock);
234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249
	struct device *dev = spi->master->dev.parent;
	int status;

	/* Chipselects are numbered 0..max; validate. */
	if (spi->chip_select >= spi->master->num_chipselect) {
		dev_err(dev, "cs%d >= max %d\n",
			spi->chip_select,
			spi->master->num_chipselect);
		return -EINVAL;
	}

	/* Set the bus ID string */
	snprintf(spi->dev.bus_id, sizeof spi->dev.bus_id,
			"%s.%u", spi->master->dev.bus_id,
			spi->chip_select);

250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268

	/* We need to make sure there's no other device with this
	 * chipselect **BEFORE** we call setup(), else we'll trash
	 * its configuration.  Lock against concurrent add() calls.
	 */
	mutex_lock(&spi_add_lock);

	if (bus_find_device_by_name(&spi_bus_type, NULL, spi->dev.bus_id)
			!= NULL) {
		dev_err(dev, "chipselect %d already in use\n",
				spi->chip_select);
		status = -EBUSY;
		goto done;
	}

	/* Drivers may modify this initial i/o setup, but will
	 * normally rely on the device being setup.  Devices
	 * using SPI_CS_HIGH can't coexist well otherwise...
	 */
269 270 271 272
	status = spi->master->setup(spi);
	if (status < 0) {
		dev_err(dev, "can't %s %s, status %d\n",
				"setup", spi->dev.bus_id, status);
273
		goto done;
274 275
	}

276
	/* Device may be bound to an active driver when this returns */
277
	status = device_add(&spi->dev);
278
	if (status < 0)
279 280
		dev_err(dev, "can't %s %s, status %d\n",
				"add", spi->dev.bus_id, status);
281 282
	else
		dev_dbg(dev, "registered child %s\n", spi->dev.bus_id);
283

284 285 286
done:
	mutex_unlock(&spi_add_lock);
	return status;
287 288
}
EXPORT_SYMBOL_GPL(spi_add_device);
289

D
David Brownell 已提交
290 291 292 293 294 295 296
/**
 * spi_new_device - instantiate one new SPI device
 * @master: Controller to which device is connected
 * @chip: Describes the SPI device
 * Context: can sleep
 *
 * On typical mainboards, this is purely internal; and it's not needed
297 298 299 300
 * after board init creates the hard-wired devices.  Some development
 * platforms may not be able to use spi_register_board_info though, and
 * this is exported so that for example a USB or parport based adapter
 * driver could add devices (which it would learn about out-of-band).
301 302
 *
 * Returns the new device, or NULL.
303
 */
304 305
struct spi_device *spi_new_device(struct spi_master *master,
				  struct spi_board_info *chip)
306 307 308 309
{
	struct spi_device	*proxy;
	int			status;

310 311 312 313 314 315 316
	/* NOTE:  caller did any chip->bus_num checks necessary.
	 *
	 * Also, unless we change the return value convention to use
	 * error-or-pointer (not NULL-or-pointer), troubleshootability
	 * suggests syslogged diagnostics are best here (ugh).
	 */

317 318
	proxy = spi_alloc_device(master);
	if (!proxy)
319 320
		return NULL;

321 322
	WARN_ON(strlen(chip->modalias) >= sizeof(proxy->modalias));

323 324
	proxy->chip_select = chip->chip_select;
	proxy->max_speed_hz = chip->max_speed_hz;
325
	proxy->mode = chip->mode;
326
	proxy->irq = chip->irq;
327
	strlcpy(proxy->modalias, chip->modalias, sizeof(proxy->modalias));
328 329 330 331
	proxy->dev.platform_data = (void *) chip->platform_data;
	proxy->controller_data = chip->controller_data;
	proxy->controller_state = NULL;

332
	status = spi_add_device(proxy);
333
	if (status < 0) {
334 335
		spi_dev_put(proxy);
		return NULL;
336 337 338 339 340 341
	}

	return proxy;
}
EXPORT_SYMBOL_GPL(spi_new_device);

D
David Brownell 已提交
342 343 344 345 346 347
/**
 * spi_register_board_info - register SPI devices for a given board
 * @info: array of chip descriptors
 * @n: how many descriptors are provided
 * Context: can sleep
 *
348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365
 * Board-specific early init code calls this (probably during arch_initcall)
 * with segments of the SPI device table.  Any device nodes are created later,
 * after the relevant parent SPI controller (bus_num) is defined.  We keep
 * this table of devices forever, so that reloading a controller driver will
 * not make Linux forget about these hard-wired devices.
 *
 * Other code can also call this, e.g. a particular add-on board might provide
 * SPI devices through its expansion connector, so code initializing that board
 * would naturally declare its SPI devices.
 *
 * The board info passed can safely be __initdata ... but be careful of
 * any embedded pointers (platform_data, etc), they're copied as-is.
 */
int __init
spi_register_board_info(struct spi_board_info const *info, unsigned n)
{
	struct boardinfo	*bi;

366
	bi = kmalloc(sizeof(*bi) + n * sizeof *info, GFP_KERNEL);
367 368 369
	if (!bi)
		return -ENOMEM;
	bi->n_board_info = n;
370
	memcpy(bi->board_info, info, n * sizeof *info);
371

372
	mutex_lock(&board_lock);
373
	list_add_tail(&bi->list, &board_list);
374
	mutex_unlock(&board_lock);
375 376 377 378 379 380 381
	return 0;
}

/* FIXME someone should add support for a __setup("spi", ...) that
 * creates board info from kernel command lines
 */

382
static void scan_boardinfo(struct spi_master *master)
383 384 385
{
	struct boardinfo	*bi;

386
	mutex_lock(&board_lock);
387 388 389 390 391 392 393
	list_for_each_entry(bi, &board_list, list) {
		struct spi_board_info	*chip = bi->board_info;
		unsigned		n;

		for (n = bi->n_board_info; n > 0; n--, chip++) {
			if (chip->bus_num != master->bus_num)
				continue;
394 395
			/* NOTE: this relies on spi_new_device to
			 * issue diagnostics when given bogus inputs
396 397 398 399
			 */
			(void) spi_new_device(master, chip);
		}
	}
400
	mutex_unlock(&board_lock);
401 402 403 404
}

/*-------------------------------------------------------------------------*/

T
Tony Jones 已提交
405
static void spi_master_release(struct device *dev)
406 407 408
{
	struct spi_master *master;

T
Tony Jones 已提交
409
	master = container_of(dev, struct spi_master, dev);
410 411 412 413 414 415
	kfree(master);
}

static struct class spi_master_class = {
	.name		= "spi_master",
	.owner		= THIS_MODULE,
T
Tony Jones 已提交
416
	.dev_release	= spi_master_release,
417 418 419 420 421 422
};


/**
 * spi_alloc_master - allocate SPI master controller
 * @dev: the controller, possibly using the platform_bus
D
David Brownell 已提交
423
 * @size: how much zeroed driver-private data to allocate; the pointer to this
T
Tony Jones 已提交
424
 *	memory is in the driver_data field of the returned device,
D
David Brownell 已提交
425
 *	accessible with spi_master_get_devdata().
D
David Brownell 已提交
426
 * Context: can sleep
427 428 429
 *
 * This call is used only by SPI master controller drivers, which are the
 * only ones directly touching chip registers.  It's how they allocate
D
dmitry pervushin 已提交
430
 * an spi_master structure, prior to calling spi_register_master().
431 432 433 434 435
 *
 * This must be called from context that can sleep.  It returns the SPI
 * master structure on success, else NULL.
 *
 * The caller is responsible for assigning the bus number and initializing
D
dmitry pervushin 已提交
436
 * the master's methods before calling spi_register_master(); and (after errors
D
David Brownell 已提交
437
 * adding the device) calling spi_master_put() to prevent a memory leak.
438
 */
439
struct spi_master *spi_alloc_master(struct device *dev, unsigned size)
440 441 442
{
	struct spi_master	*master;

D
David Brownell 已提交
443 444 445
	if (!dev)
		return NULL;

446
	master = kzalloc(size + sizeof *master, GFP_KERNEL);
447 448 449
	if (!master)
		return NULL;

T
Tony Jones 已提交
450 451 452
	device_initialize(&master->dev);
	master->dev.class = &spi_master_class;
	master->dev.parent = get_device(dev);
D
David Brownell 已提交
453
	spi_master_set_devdata(master, &master[1]);
454 455 456 457 458 459 460 461

	return master;
}
EXPORT_SYMBOL_GPL(spi_alloc_master);

/**
 * spi_register_master - register SPI master controller
 * @master: initialized master, originally from spi_alloc_master()
D
David Brownell 已提交
462
 * Context: can sleep
463 464 465 466 467 468 469 470 471 472 473 474 475
 *
 * SPI master controllers connect to their drivers using some non-SPI bus,
 * such as the platform bus.  The final stage of probe() in that code
 * includes calling spi_register_master() to hook up to this SPI bus glue.
 *
 * SPI controllers use board specific (often SOC specific) bus numbers,
 * and board-specific addressing for SPI devices combines those numbers
 * with chip select numbers.  Since SPI does not directly support dynamic
 * device identification, boards need configuration tables telling which
 * chip is at which address.
 *
 * This must be called from context that can sleep.  It returns zero on
 * success, else a negative error code (dropping the master's refcount).
D
David Brownell 已提交
476 477
 * After a successful return, the caller is responsible for calling
 * spi_unregister_master().
478
 */
479
int spi_register_master(struct spi_master *master)
480
{
481
	static atomic_t		dyn_bus_id = ATOMIC_INIT((1<<15) - 1);
T
Tony Jones 已提交
482
	struct device		*dev = master->dev.parent;
483 484 485
	int			status = -ENODEV;
	int			dynamic = 0;

D
David Brownell 已提交
486 487 488
	if (!dev)
		return -ENODEV;

489 490 491 492 493 494
	/* even if it's just one always-selected device, there must
	 * be at least one chipselect
	 */
	if (master->num_chipselect == 0)
		return -EINVAL;

495
	/* convention:  dynamically assigned bus IDs count down from the max */
496
	if (master->bus_num < 0) {
497 498 499
		/* FIXME switch to an IDR based scheme, something like
		 * I2C now uses, so we can't run out of "dynamic" IDs
		 */
500
		master->bus_num = atomic_dec_return(&dyn_bus_id);
501
		dynamic = 1;
502 503 504 505 506
	}

	/* register the device, then userspace will see it.
	 * registration fails if the bus ID is in use.
	 */
T
Tony Jones 已提交
507
	snprintf(master->dev.bus_id, sizeof master->dev.bus_id,
508
		"spi%u", master->bus_num);
T
Tony Jones 已提交
509
	status = device_add(&master->dev);
510
	if (status < 0)
511
		goto done;
T
Tony Jones 已提交
512
	dev_dbg(dev, "registered master %s%s\n", master->dev.bus_id,
513 514 515 516 517 518 519 520 521 522 523
			dynamic ? " (dynamic)" : "");

	/* populate children from any spi device tables */
	scan_boardinfo(master);
	status = 0;
done:
	return status;
}
EXPORT_SYMBOL_GPL(spi_register_master);


524
static int __unregister(struct device *dev, void *master_dev)
525 526
{
	/* note: before about 2.6.14-rc1 this would corrupt memory: */
527 528
	if (dev != master_dev)
		spi_unregister_device(to_spi_device(dev));
529 530 531 532 533 534
	return 0;
}

/**
 * spi_unregister_master - unregister SPI master controller
 * @master: the master being unregistered
D
David Brownell 已提交
535
 * Context: can sleep
536 537 538 539 540 541 542 543
 *
 * This call is used only by SPI master controller drivers, which are the
 * only ones directly touching chip registers.
 *
 * This must be called from context that can sleep.
 */
void spi_unregister_master(struct spi_master *master)
{
544 545
	int dummy;

546 547
	dummy = device_for_each_child(master->dev.parent, &master->dev,
					__unregister);
T
Tony Jones 已提交
548
	device_unregister(&master->dev);
549 550 551
}
EXPORT_SYMBOL_GPL(spi_unregister_master);

D
Dave Young 已提交
552 553 554 555 556 557 558 559 560
static int __spi_master_match(struct device *dev, void *data)
{
	struct spi_master *m;
	u16 *bus_num = data;

	m = container_of(dev, struct spi_master, dev);
	return m->bus_num == *bus_num;
}

561 562 563
/**
 * spi_busnum_to_master - look up master associated with bus_num
 * @bus_num: the master's bus number
D
David Brownell 已提交
564
 * Context: can sleep
565 566 567 568 569 570 571 572
 *
 * This call may be used with devices that are registered after
 * arch init time.  It returns a refcounted pointer to the relevant
 * spi_master (which the caller must release), or NULL if there is
 * no such master registered.
 */
struct spi_master *spi_busnum_to_master(u16 bus_num)
{
T
Tony Jones 已提交
573
	struct device		*dev;
574
	struct spi_master	*master = NULL;
D
Dave Young 已提交
575

576
	dev = class_find_device(&spi_master_class, NULL, &bus_num,
D
Dave Young 已提交
577 578 579 580
				__spi_master_match);
	if (dev)
		master = container_of(dev, struct spi_master, dev);
	/* reference got in class_find_device */
581
	return master;
582 583 584 585 586 587
}
EXPORT_SYMBOL_GPL(spi_busnum_to_master);


/*-------------------------------------------------------------------------*/

588 589 590 591 592
static void spi_complete(void *arg)
{
	complete(arg);
}

593 594 595 596
/**
 * spi_sync - blocking/synchronous SPI data transfers
 * @spi: device with which data will be exchanged
 * @message: describes the data transfers
D
David Brownell 已提交
597
 * Context: can sleep
598 599 600 601 602 603 604 605 606 607 608
 *
 * This call may only be used from a context that may sleep.  The sleep
 * is non-interruptible, and has no timeout.  Low-overhead controller
 * drivers may DMA directly into and out of the message buffers.
 *
 * Note that the SPI device's chip select is active during the message,
 * and then is normally disabled between messages.  Drivers for some
 * frequently-used devices may want to minimize costs of selecting a chip,
 * by leaving it selected in anticipation that the next message will go
 * to the same chip.  (That may increase power usage.)
 *
D
David Brownell 已提交
609 610 611
 * Also, the caller is guaranteeing that the memory associated with the
 * message will not be freed before this call returns.
 *
612
 * It returns zero on success, else a negative error code.
613 614 615
 */
int spi_sync(struct spi_device *spi, struct spi_message *message)
{
616
	DECLARE_COMPLETION_ONSTACK(done);
617 618
	int status;

619
	message->complete = spi_complete;
620 621
	message->context = &done;
	status = spi_async(spi, message);
622
	if (status == 0) {
623
		wait_for_completion(&done);
624 625
		status = message->status;
	}
626 627 628 629 630
	message->context = NULL;
	return status;
}
EXPORT_SYMBOL_GPL(spi_sync);

631 632
/* portable code must never pass more than 32 bytes */
#define	SPI_BUFSIZ	max(32,SMP_CACHE_BYTES)
633 634 635 636 637 638 639 640 641 642

static u8	*buf;

/**
 * spi_write_then_read - SPI synchronous write followed by read
 * @spi: device with which data will be exchanged
 * @txbuf: data to be written (need not be dma-safe)
 * @n_tx: size of txbuf, in bytes
 * @rxbuf: buffer into which data will be read
 * @n_rx: size of rxbuf, in bytes (need not be dma-safe)
D
David Brownell 已提交
643
 * Context: can sleep
644 645 646 647
 *
 * This performs a half duplex MicroWire style transaction with the
 * device, sending txbuf and then reading rxbuf.  The return value
 * is zero for success, else a negative errno status code.
648
 * This call may only be used from a context that may sleep.
649
 *
D
David Brownell 已提交
650
 * Parameters to this routine are always copied using a small buffer;
D
David Brownell 已提交
651 652
 * portable code should never use this for more than 32 bytes.
 * Performance-sensitive or bulk transfer code should instead use
D
David Brownell 已提交
653
 * spi_{async,sync}() calls with dma-safe buffers.
654 655 656 657 658
 */
int spi_write_then_read(struct spi_device *spi,
		const u8 *txbuf, unsigned n_tx,
		u8 *rxbuf, unsigned n_rx)
{
D
David Brownell 已提交
659
	static DEFINE_MUTEX(lock);
660 661 662

	int			status;
	struct spi_message	message;
663
	struct spi_transfer	x;
664 665 666 667 668 669 670 671 672
	u8			*local_buf;

	/* Use preallocated DMA-safe buffer.  We can't avoid copying here,
	 * (as a pure convenience thing), but we can keep heap costs
	 * out of the hot path ...
	 */
	if ((n_tx + n_rx) > SPI_BUFSIZ)
		return -EINVAL;

673
	spi_message_init(&message);
674 675 676
	memset(&x, 0, sizeof x);
	x.len = n_tx + n_rx;
	spi_message_add_tail(&x, &message);
677

678
	/* ... unless someone else is using the pre-allocated buffer */
D
David Brownell 已提交
679
	if (!mutex_trylock(&lock)) {
680 681 682 683 684 685 686
		local_buf = kmalloc(SPI_BUFSIZ, GFP_KERNEL);
		if (!local_buf)
			return -ENOMEM;
	} else
		local_buf = buf;

	memcpy(local_buf, txbuf, n_tx);
687 688
	x.tx_buf = local_buf;
	x.rx_buf = local_buf;
689 690 691

	/* do the i/o */
	status = spi_sync(spi, &message);
692
	if (status == 0)
693
		memcpy(rxbuf, x.rx_buf + n_tx, n_rx);
694

695
	if (x.tx_buf == buf)
D
David Brownell 已提交
696
		mutex_unlock(&lock);
697 698 699 700 701 702 703 704 705 706 707
	else
		kfree(local_buf);

	return status;
}
EXPORT_SYMBOL_GPL(spi_write_then_read);

/*-------------------------------------------------------------------------*/

static int __init spi_init(void)
{
708 709
	int	status;

710
	buf = kmalloc(SPI_BUFSIZ, GFP_KERNEL);
711 712 713 714 715 716 717 718
	if (!buf) {
		status = -ENOMEM;
		goto err0;
	}

	status = bus_register(&spi_bus_type);
	if (status < 0)
		goto err1;
719

720 721 722
	status = class_register(&spi_master_class);
	if (status < 0)
		goto err2;
723
	return 0;
724 725 726 727 728 729 730 731

err2:
	bus_unregister(&spi_bus_type);
err1:
	kfree(buf);
	buf = NULL;
err0:
	return status;
732
}
733

734 735
/* board_info is normally registered in arch_initcall(),
 * but even essential drivers wait till later
736 737 738 739
 *
 * REVISIT only boardinfo really needs static linking. the rest (device and
 * driver registration) _could_ be dynamically linked (modular) ... costs
 * include needing to have boardinfo data structures be much more public.
740
 */
741
postcore_initcall(spi_init);
742