111 lines
1.9 KiB
C
111 lines
1.9 KiB
C
/*
|
|
* Copyright (c) 2012 Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
|
|
*
|
|
* Under GPLv2
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <driver.h>
|
|
#include <errno.h>
|
|
#include <of.h>
|
|
|
|
LIST_HEAD(bus_list);
|
|
EXPORT_SYMBOL(bus_list);
|
|
|
|
static struct bus_type *get_bus_by_name(const char *name)
|
|
{
|
|
struct bus_type *bus;
|
|
|
|
for_each_bus(bus) {
|
|
if(!strcmp(bus->name, name))
|
|
return bus;
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
int bus_register(struct bus_type *bus)
|
|
{
|
|
int ret;
|
|
|
|
if (get_bus_by_name(bus->name))
|
|
return -EEXIST;
|
|
|
|
bus->dev = xzalloc(sizeof(*bus->dev));
|
|
strcpy(bus->dev->name, bus->name);
|
|
bus->dev->id = DEVICE_ID_SINGLE;
|
|
|
|
ret = register_device(bus->dev);
|
|
if (ret)
|
|
return ret;
|
|
|
|
|
|
INIT_LIST_HEAD(&bus->device_list);
|
|
INIT_LIST_HEAD(&bus->driver_list);
|
|
|
|
list_add_tail(&bus->list, &bus_list);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int device_match(struct device_d *dev, struct driver_d *drv)
|
|
{
|
|
if (IS_ENABLED(CONFIG_OFDEVICE) && dev->device_node &&
|
|
drv->of_compatible)
|
|
return of_match(dev, drv);
|
|
|
|
if (!strcmp(dev->name, drv->name))
|
|
return 0;
|
|
|
|
if (drv->id_table) {
|
|
struct platform_device_id *id = drv->id_table;
|
|
|
|
while (id->name) {
|
|
if (!strcmp(id->name, dev->name)) {
|
|
dev->id_entry = id;
|
|
return 0;
|
|
}
|
|
id++;
|
|
}
|
|
}
|
|
|
|
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;
|
|
}
|