@@ -196,13 +196,16 @@ EXPORT_SYMBOL_GPL(spi_register_driver);
struct boardinfo {
struct list_head list;
- unsigned n_board_info;
- struct spi_board_info board_info[0];
+ struct spi_board_info board_info;
};
static LIST_HEAD(board_list);
static DEFINE_MUTEX(board_lock);
+
+static LIST_HEAD(master_list);
+static DEFINE_MUTEX(master_lock);
+
/**
* spi_alloc_device - Allocate a new SPI device
* @master: Controller to which device is connected
@@ -365,6 +368,19 @@ struct spi_device *spi_new_device(struct spi_master *master,
}
EXPORT_SYMBOL_GPL(spi_new_device);
+static void scan_masterlist(struct spi_board_info *bi)
+{
+ struct spi_master *master;
+
+ mutex_lock(&master_lock);
+ list_for_each_entry(master, &master_list, list) {
+ if (master->bus_num != bi->bus_num)
+ continue;
+ (void) spi_new_device(master, bi);
+ }
+ mutex_unlock(&master_lock);
+}
+
/**
* spi_register_board_info - register SPI devices for a given board
* @info: array of chip descriptors
@@ -387,41 +403,45 @@ EXPORT_SYMBOL_GPL(spi_new_device);
int __init
spi_register_board_info(struct spi_board_info const *info, unsigned n)
{
- struct boardinfo *bi;
+ struct boardinfo *bi, *tmp_bi;
+ int i;
- bi = kmalloc(sizeof(*bi) + n * sizeof *info, GFP_KERNEL);
+ bi = kzalloc(n * sizeof *bi, GFP_KERNEL);
if (!bi)
return -ENOMEM;
- bi->n_board_info = n;
- memcpy(bi->board_info, info, n * sizeof *info);
+ tmp_bi = bi;
mutex_lock(&board_lock);
- list_add_tail(&bi->list, &board_list);
+ for (i = 0; i < n; i++, bi++, info++) {
+ memcpy(&bi->board_info, info, sizeof *info);
+ list_add_tail(&bi->list, &board_list);
+ }
mutex_unlock(&board_lock);
+
+ bi = tmp_bi;
+ for (i = 0; i < n; i++)
+ scan_masterlist(&bi->board_info);
+
return 0;
}
/* FIXME someone should add support for a __setup("spi", ...) that
* creates board info from kernel command lines
*/
-
static void scan_boardinfo(struct spi_master *master)
{
struct boardinfo *bi;
mutex_lock(&board_lock);
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;
- /* NOTE: this relies on spi_new_device to
- * issue diagnostics when given bogus inputs
- */
- (void) spi_new_device(master, chip);
- }
+ struct spi_board_info *chip = &bi->board_info;
+
+ if (chip->bus_num != master->bus_num)
+ continue;
+ /* NOTE: this relies on spi_new_device to
+ * issue diagnostics when given bogus inputs
+ */
+ (void) spi_new_device(master, chip);
}
mutex_unlock(&board_lock);
}
@@ -537,6 +557,10 @@ int spi_register_master(struct spi_master *master)
dev_dbg(dev, "registered master %s%s\n", dev_name(&master->dev),
dynamic ? " (dynamic)" : "");
+ mutex_lock(&master_lock);
+ list_add_tail(&master->list, &master_list);
+ mutex_unlock(&master_lock);
+
/* populate children from any spi device tables */
scan_boardinfo(master);
status = 0;
@@ -568,6 +592,10 @@ void spi_unregister_master(struct spi_master *master)
{
int dummy;
+ mutex_lock(&master_lock);
+ list_del(&master->list);
+ mutex_unlock(&master_lock);
+
dummy = device_for_each_child(master->dev.parent, &master->dev,
__unregister);
device_unregister(&master->dev);
@@ -204,6 +204,7 @@ static inline void spi_unregister_driver(struct spi_driver *sdrv)
/**
* struct spi_master - interface to SPI master controller
* @dev: device interface to this driver
+ * @list: link with the global spi_master list
* @bus_num: board-specific (and often SOC-specific) identifier for a
* given SPI controller.
* @num_chipselect: chipselects are used to distinguish individual
@@ -235,6 +236,8 @@ static inline void spi_unregister_driver(struct spi_driver *sdrv)
struct spi_master {
struct device dev;
+ struct list_head list;
+
/* other than negative (== assign one dynamically), bus_num is fully
* board-specific. usually that simplifies to being SOC-specific.
* example: one SOC has three SPI controllers, numbered 0..2,