9
0
Fork 0

device: Add functions to add resources

We currently have functions to add a device based on function parameters.
This adds the corresponding functions to add resources to a device without
registering the device itself. This is useful to manipulate devices before
registering them.

Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
This commit is contained in:
Sascha Hauer 2013-11-25 15:39:11 +01:00
parent 54f55d79d9
commit f92f309c54
2 changed files with 56 additions and 13 deletions

View File

@ -20,33 +20,67 @@
#include <common.h> #include <common.h>
#include <driver.h> #include <driver.h>
#include <xfuncs.h> #include <xfuncs.h>
#include <malloc.h>
static struct device_d *alloc_device(const char* devname, int id, void *pdata) struct device_d *device_alloc(const char *devname, int id)
{ {
struct device_d *dev; struct device_d *dev;
dev = xzalloc(sizeof(*dev)); dev = xzalloc(sizeof(*dev));
strcpy(dev->name, devname); strcpy(dev->name, devname);
dev->id = id; dev->id = id;
dev->platform_data = pdata;
return dev; return dev;
} }
int device_add_data(struct device_d *dev, void *data, size_t size)
{
free(dev->platform_data);
if (data)
dev->platform_data = xmemdup(data, size);
else
dev->platform_data = NULL;
return 0;
}
int device_add_resources(struct device_d *dev, const struct resource *res, int num)
{
dev->resource = xmemdup(res, sizeof(*res) * num);
dev->num_resources = num;
return 0;
}
int device_add_resource(struct device_d *dev, const char *resname,
resource_size_t start, resource_size_t size, unsigned int flags)
{
struct resource res = {
.start = start,
.end = start + size - 1,
.flags = flags,
};
if (resname)
res.name = xstrdup(resname);
return device_add_resources(dev, &res, 1);
}
struct device_d *add_generic_device(const char* devname, int id, const char *resname, struct device_d *add_generic_device(const char* devname, int id, const char *resname,
resource_size_t start, resource_size_t size, unsigned int flags, resource_size_t start, resource_size_t size, unsigned int flags,
void *pdata) void *pdata)
{ {
struct resource *res; struct device_d *dev;
res = xzalloc(sizeof(struct resource)); dev = device_alloc(devname, id);
if (resname) dev->platform_data = pdata;
res[0].name = xstrdup(resname); device_add_resource(dev, resname, start, size, flags);
res[0].start = start;
res[0].end = start + size - 1;
res[0].flags = flags;
return add_generic_device_res(devname, id, res, 1, pdata); platform_device_register(dev);
return dev;
} }
EXPORT_SYMBOL(add_generic_device); EXPORT_SYMBOL(add_generic_device);
@ -55,9 +89,9 @@ struct device_d *add_generic_device_res(const char* devname, int id,
{ {
struct device_d *dev; struct device_d *dev;
dev = alloc_device(devname, id, pdata); dev = device_alloc(devname, id);
dev->resource = res; dev->platform_data = pdata;
dev->num_resources = nb; device_add_resources(dev, res, nb);
platform_device_register(dev); platform_device_register(dev);

View File

@ -229,6 +229,15 @@ void *dev_get_mem_region(struct device_d *dev, int num);
*/ */
void __iomem *dev_request_mem_region(struct device_d *dev, int num); void __iomem *dev_request_mem_region(struct device_d *dev, int num);
struct device_d *device_alloc(const char *devname, int id);
int device_add_resources(struct device_d *dev, const struct resource *res, int num);
int device_add_resource(struct device_d *dev, const char *resname,
resource_size_t start, resource_size_t size, unsigned int flags);
int device_add_data(struct device_d *dev, void *data, size_t size);
/* /*
* register a generic device * register a generic device
* with only one resource * with only one resource