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:
parent
54f55d79d9
commit
f92f309c54
|
@ -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);
|
||||||
|
|
||||||
|
|
|
@ -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
|
||||||
|
|
Loading…
Reference in New Issue