9
0
Fork 0

Merge branch 'for-next/modalias'

This commit is contained in:
Sascha Hauer 2014-03-07 09:25:12 +01:00
commit 98615784a6
5 changed files with 56 additions and 16 deletions

View File

@ -71,3 +71,40 @@ int device_match(struct device_d *dev, struct driver_d *drv)
return -1;
}
int device_match_of_modalias(struct device_d *dev, struct driver_d *drv)
{
struct platform_device_id *id = drv->id_table;
const char *of_modalias = NULL, *p;
int cplen;
const char *compat;
if (!device_match(dev, drv))
return 0;
if (!id || !IS_ENABLED(CONFIG_OFDEVICE) || !dev->device_node)
return -1;
compat = of_get_property(dev->device_node, "compatible", &cplen);
if (!compat)
return -1;
p = strchr(compat, ',');
of_modalias = p ? p + 1 : compat;
while (id->name) {
if (!strcmp(id->name, dev->name)) {
dev->id_entry = id;
return 0;
}
if (of_modalias && !strcmp(id->name, of_modalias)) {
dev->id_entry = id;
return 0;
}
id++;
}
return -1;
}

View File

@ -466,7 +466,7 @@ static void i2c_remove(struct device_d *dev)
struct bus_type i2c_bus = {
.name = "i2c",
.match = device_match,
.match = device_match_of_modalias,
.probe = i2c_probe,
.remove = i2c_remove,
};

View File

@ -73,11 +73,6 @@
#define SPI_NAME_SIZE 32
struct spi_device_id {
char name[SPI_NAME_SIZE];
unsigned long driver_data;
};
struct m25p {
struct spi_device *spi;
struct mtd_info mtd;
@ -618,7 +613,7 @@ struct flash_info {
* more flash chips. This current list focusses on newer chips, which
* have been converging on command sets which including JEDEC ID.
*/
static const struct spi_device_id m25p_ids[] = {
static const struct platform_device_id m25p_ids[] = {
/* Atmel -- some are (confusingly) marketed as "DataFlash" */
{ "at25fs010", INFO(0x1f6601, 0, 32 * 1024, 4, SECT_4K) },
{ "at25fs040", INFO(0x1f6604, 0, 64 * 1024, 8, SECT_4K) },
@ -755,7 +750,7 @@ static const struct spi_device_id m25p_ids[] = {
{ },
};
static const struct spi_device_id *jedec_probe(struct spi_device *spi)
static const struct platform_device_id *jedec_probe(struct spi_device *spi)
{
int tmp;
u8 code = OPCODE_RDID;
@ -803,13 +798,14 @@ static const struct spi_device_id *jedec_probe(struct spi_device *spi)
static int m25p_probe(struct device_d *dev)
{
struct spi_device *spi = (struct spi_device *)dev->type_data;
const struct spi_device_id *id = NULL;
const struct platform_device_id *id = NULL;
struct flash_platform_data *data;
struct m25p *flash;
struct flash_info *info = NULL;
unsigned i;
unsigned do_jdec_probe = 1;
char *flashname = NULL;
const char *typename = NULL;
int device_id;
/* Platform data helps sort out which chip type we have, as
@ -818,12 +814,17 @@ static int m25p_probe(struct device_d *dev)
* newer chips, even if we don't recognize the particular chip.
*/
data = dev->platform_data;
if (data && data->type) {
const struct spi_device_id *plat_id;
if (data && data->type)
typename = data->type;
else if (dev->id_entry)
typename = dev->id_entry->name;
if (typename) {
const struct platform_device_id *plat_id;
for (i = 0; i < ARRAY_SIZE(m25p_ids) - 1; i++) {
plat_id = &m25p_ids[i];
if (strcmp(data->type, plat_id->name))
if (strcmp(typename, plat_id->name))
continue;
break;
}
@ -836,11 +837,11 @@ static int m25p_probe(struct device_d *dev)
if (!info->jedec_id)
do_jdec_probe = 0;
} else
dev_warn(&spi->dev, "unrecognized id %s\n", data->type);
dev_warn(&spi->dev, "unrecognized id %s\n", typename);
}
if (do_jdec_probe) {
const struct spi_device_id *jid;
const struct platform_device_id *jid;
jid = jedec_probe(spi);
if (IS_ERR(jid)) {
@ -969,6 +970,7 @@ static struct driver_d m25p80_driver = {
.name = "m25p80",
.probe = m25p_probe,
.of_compatible = DRV_OF_COMPAT(m25p80_dt_ids),
.id_table = (struct platform_device_id *)m25p_ids,
};
device_spi_driver(m25p80_driver);

View File

@ -316,7 +316,7 @@ static void spi_remove(struct device_d *dev)
struct bus_type spi_bus = {
.name = "spi",
.match = device_match,
.match = device_match_of_modalias,
.probe = spi_probe,
.remove = spi_remove,
};

View File

@ -496,5 +496,6 @@ int devfs_del_partition(const char *name);
int dev_get_drvdata(struct device_d *dev, unsigned long *data);
#endif /* DRIVER_H */
int device_match_of_modalias(struct device_d *dev, struct driver_d *drv);
#endif /* DRIVER_H */