2007-07-05 16:02:19 +00:00
|
|
|
/*
|
2009-12-15 08:11:09 +00:00
|
|
|
* driver.c - barebox driver model
|
2007-07-05 16:02:19 +00:00
|
|
|
*
|
|
|
|
* Copyright (c) 2007 Sascha Hauer <s.hauer@pengutronix.de>, Pengutronix
|
|
|
|
*
|
|
|
|
* See file CREDITS for list of people who contributed to this
|
|
|
|
* project.
|
|
|
|
*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License version 2
|
|
|
|
* as published by the Free Software Foundation.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
* GNU General Public License for more details.
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
2007-11-08 11:01:52 +00:00
|
|
|
/**
|
|
|
|
* @file
|
2009-12-15 08:11:09 +00:00
|
|
|
* @brief barebox's driver model, and devinfo command
|
2007-11-08 11:01:52 +00:00
|
|
|
*/
|
|
|
|
|
2007-07-05 16:02:12 +00:00
|
|
|
#include <common.h>
|
|
|
|
#include <command.h>
|
|
|
|
#include <driver.h>
|
|
|
|
#include <malloc.h>
|
2013-02-07 12:47:26 +00:00
|
|
|
#include <console.h>
|
2007-07-05 16:02:12 +00:00
|
|
|
#include <linux/ctype.h>
|
|
|
|
#include <errno.h>
|
|
|
|
#include <fs.h>
|
2013-07-10 07:27:06 +00:00
|
|
|
#include <of.h>
|
2009-11-02 13:31:18 +00:00
|
|
|
#include <linux/list.h>
|
2011-06-05 12:58:08 +00:00
|
|
|
#include <complete.h>
|
2013-04-21 14:48:47 +00:00
|
|
|
#include <pinctrl.h>
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2007-10-11 18:20:36 +00:00
|
|
|
LIST_HEAD(device_list);
|
|
|
|
EXPORT_SYMBOL(device_list);
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2007-10-11 18:20:36 +00:00
|
|
|
LIST_HEAD(driver_list);
|
|
|
|
EXPORT_SYMBOL(driver_list);
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2009-02-21 00:17:10 +00:00
|
|
|
static LIST_HEAD(active);
|
|
|
|
|
2009-06-11 13:33:49 +00:00
|
|
|
struct device_d *get_device_by_name(const char *name)
|
2009-04-22 21:39:27 +00:00
|
|
|
{
|
|
|
|
struct device_d *dev;
|
|
|
|
|
|
|
|
for_each_device(dev) {
|
2010-08-29 16:17:52 +00:00
|
|
|
if(!strcmp(dev_name(dev), name))
|
2009-04-22 21:39:27 +00:00
|
|
|
return dev;
|
|
|
|
}
|
|
|
|
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
2010-10-15 07:40:29 +00:00
|
|
|
static struct device_d *get_device_by_name_id(const char *name, int id)
|
2010-09-12 11:19:08 +00:00
|
|
|
{
|
|
|
|
struct device_d *dev;
|
|
|
|
|
|
|
|
for_each_device(dev) {
|
|
|
|
if(!strcmp(dev->name, name) && id == dev->id)
|
|
|
|
return dev;
|
|
|
|
}
|
|
|
|
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
2009-06-11 13:33:49 +00:00
|
|
|
int get_free_deviceid(const char *name_template)
|
2007-07-05 16:02:12 +00:00
|
|
|
{
|
|
|
|
int i = 0;
|
|
|
|
|
|
|
|
while (1) {
|
2010-09-12 11:19:08 +00:00
|
|
|
if (!get_device_by_name_id(name_template, i))
|
2009-06-11 13:33:49 +00:00
|
|
|
return i;
|
2007-07-05 16:02:12 +00:00
|
|
|
i++;
|
|
|
|
};
|
|
|
|
}
|
|
|
|
|
2012-11-18 12:49:39 +00:00
|
|
|
int device_probe(struct device_d *dev)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
2013-04-21 14:48:47 +00:00
|
|
|
pinctrl_select_state_default(dev);
|
|
|
|
|
2012-11-18 12:49:39 +00:00
|
|
|
ret = dev->bus->probe(dev);
|
|
|
|
if (ret) {
|
|
|
|
dev_err(dev, "probe failed: %s\n", strerror(-ret));
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
list_add(&dev->active, &active);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2013-05-24 13:42:27 +00:00
|
|
|
int device_detect(struct device_d *dev)
|
|
|
|
{
|
|
|
|
if (!dev->detect)
|
|
|
|
return -ENOSYS;
|
|
|
|
return dev->detect(dev);
|
|
|
|
}
|
|
|
|
|
2013-06-26 05:40:49 +00:00
|
|
|
int device_detect_by_name(const char *devname)
|
|
|
|
{
|
|
|
|
struct device_d *dev = get_device_by_name(devname);
|
|
|
|
|
|
|
|
if (!dev)
|
|
|
|
return -ENODEV;
|
|
|
|
|
|
|
|
return device_detect(dev);
|
|
|
|
}
|
|
|
|
|
2007-07-05 16:02:12 +00:00
|
|
|
static int match(struct driver_d *drv, struct device_d *dev)
|
|
|
|
{
|
2012-10-06 21:01:26 +00:00
|
|
|
int ret;
|
|
|
|
|
2009-02-27 17:08:45 +00:00
|
|
|
if (dev->driver)
|
|
|
|
return -1;
|
|
|
|
|
2007-10-11 18:56:18 +00:00
|
|
|
dev->driver = drv;
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2009-02-25 23:51:19 +00:00
|
|
|
if (dev->bus->match(dev, drv))
|
|
|
|
goto err_out;
|
2012-11-18 12:49:39 +00:00
|
|
|
ret = device_probe(dev);
|
|
|
|
if (ret)
|
2009-02-25 23:51:19 +00:00
|
|
|
goto err_out;
|
2009-02-21 00:17:10 +00:00
|
|
|
|
2007-10-11 18:56:18 +00:00
|
|
|
return 0;
|
2009-02-25 23:51:19 +00:00
|
|
|
err_out:
|
|
|
|
dev->driver = NULL;
|
|
|
|
return -1;
|
2007-07-05 16:02:12 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
int register_device(struct device_d *new_device)
|
|
|
|
{
|
|
|
|
struct driver_d *drv;
|
|
|
|
|
2012-04-15 14:02:02 +00:00
|
|
|
if (new_device->id == DEVICE_ID_DYNAMIC) {
|
2010-09-12 11:19:08 +00:00
|
|
|
new_device->id = get_free_deviceid(new_device->name);
|
|
|
|
} else {
|
|
|
|
if (get_device_by_name_id(new_device->name, new_device->id)) {
|
|
|
|
eprintf("register_device: already registered %s\n",
|
|
|
|
dev_name(new_device));
|
|
|
|
return -EINVAL;
|
|
|
|
}
|
|
|
|
}
|
2009-06-11 13:33:49 +00:00
|
|
|
|
2010-08-29 16:17:52 +00:00
|
|
|
debug ("register_device: %s\n", dev_name(new_device));
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2007-10-11 18:20:36 +00:00
|
|
|
list_add_tail(&new_device->list, &device_list);
|
2007-10-19 06:45:57 +00:00
|
|
|
INIT_LIST_HEAD(&new_device->children);
|
2009-06-11 13:33:49 +00:00
|
|
|
INIT_LIST_HEAD(&new_device->cdevs);
|
2010-06-03 08:13:29 +00:00
|
|
|
INIT_LIST_HEAD(&new_device->parameters);
|
2011-08-15 07:18:19 +00:00
|
|
|
INIT_LIST_HEAD(&new_device->active);
|
2014-01-14 09:22:55 +00:00
|
|
|
INIT_LIST_HEAD(&new_device->bus_list);
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2012-12-12 13:55:40 +00:00
|
|
|
if (new_device->bus) {
|
|
|
|
if (!new_device->parent)
|
2013-03-06 19:03:50 +00:00
|
|
|
new_device->parent = new_device->bus->dev;
|
2012-09-19 19:22:17 +00:00
|
|
|
|
2012-12-12 13:55:40 +00:00
|
|
|
list_add_tail(&new_device->bus_list, &new_device->bus->device_list);
|
2012-09-19 19:22:17 +00:00
|
|
|
|
2012-12-12 13:55:40 +00:00
|
|
|
bus_for_each_driver(new_device->bus, drv) {
|
|
|
|
if (!match(drv, new_device))
|
|
|
|
break;
|
|
|
|
}
|
2007-10-11 18:56:18 +00:00
|
|
|
}
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2012-12-12 13:55:40 +00:00
|
|
|
if (new_device->parent)
|
|
|
|
list_add_tail(&new_device->sibling, &new_device->parent->children);
|
|
|
|
|
2007-07-05 16:02:12 +00:00
|
|
|
return 0;
|
|
|
|
}
|
2007-10-07 12:27:24 +00:00
|
|
|
EXPORT_SYMBOL(register_device);
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2007-10-19 06:45:57 +00:00
|
|
|
int unregister_device(struct device_d *old_dev)
|
2007-07-05 16:02:12 +00:00
|
|
|
{
|
2012-02-13 18:46:10 +00:00
|
|
|
struct cdev *cdev, *ct;
|
|
|
|
struct device_d *child, *dt;
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2012-02-13 18:46:10 +00:00
|
|
|
dev_dbg(old_dev, "unregister\n");
|
2007-10-19 06:45:57 +00:00
|
|
|
|
2014-01-14 09:24:23 +00:00
|
|
|
dev_remove_parameters(old_dev);
|
|
|
|
|
2007-10-11 18:20:36 +00:00
|
|
|
if (old_dev->driver)
|
2009-04-06 17:08:37 +00:00
|
|
|
old_dev->bus->remove(old_dev);
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2012-02-13 18:46:10 +00:00
|
|
|
list_for_each_entry_safe(child, dt, &old_dev->children, sibling) {
|
|
|
|
dev_dbg(old_dev, "unregister child %s\n", dev_name(child));
|
|
|
|
unregister_device(child);
|
|
|
|
}
|
|
|
|
|
|
|
|
list_for_each_entry_safe(cdev, ct, &old_dev->cdevs, devices_list) {
|
|
|
|
if (cdev->flags & DEVFS_IS_PARTITION) {
|
|
|
|
dev_dbg(old_dev, "unregister part %s\n", cdev->name);
|
|
|
|
devfs_del_partition(cdev->name);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2007-10-11 18:20:36 +00:00
|
|
|
list_del(&old_dev->list);
|
2012-09-20 05:36:45 +00:00
|
|
|
list_del(&old_dev->bus_list);
|
2011-03-24 17:53:45 +00:00
|
|
|
list_del(&old_dev->active);
|
2007-10-19 06:45:57 +00:00
|
|
|
|
|
|
|
/* remove device from parents child list */
|
|
|
|
if (old_dev->parent)
|
|
|
|
list_del(&old_dev->sibling);
|
|
|
|
|
|
|
|
return 0;
|
2007-07-05 16:02:12 +00:00
|
|
|
}
|
2007-10-07 12:27:24 +00:00
|
|
|
EXPORT_SYMBOL(unregister_device);
|
2007-07-05 16:02:12 +00:00
|
|
|
|
|
|
|
struct driver_d *get_driver_by_name(const char *name)
|
|
|
|
{
|
2007-10-11 18:20:36 +00:00
|
|
|
struct driver_d *drv;
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2007-10-11 18:20:36 +00:00
|
|
|
for_each_driver(drv) {
|
|
|
|
if(!strcmp(name, drv->name))
|
|
|
|
return drv;
|
2007-07-05 16:02:12 +00:00
|
|
|
}
|
|
|
|
|
2007-10-11 18:20:36 +00:00
|
|
|
return NULL;
|
2007-07-05 16:02:12 +00:00
|
|
|
}
|
|
|
|
|
2007-10-11 18:20:36 +00:00
|
|
|
int register_driver(struct driver_d *drv)
|
2007-07-05 16:02:12 +00:00
|
|
|
{
|
2007-10-11 18:56:18 +00:00
|
|
|
struct device_d *dev = NULL;
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2007-10-19 06:45:57 +00:00
|
|
|
debug("register_driver: %s\n", drv->name);
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2012-09-19 19:22:17 +00:00
|
|
|
BUG_ON(!drv->bus);
|
2009-02-25 23:51:19 +00:00
|
|
|
|
2007-10-11 18:20:36 +00:00
|
|
|
list_add_tail(&drv->list, &driver_list);
|
2012-09-20 05:36:45 +00:00
|
|
|
list_add_tail(&drv->bus_list, &drv->bus->driver_list);
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2012-09-20 05:36:45 +00:00
|
|
|
bus_for_each_device(drv->bus, dev)
|
2007-10-11 18:56:18 +00:00
|
|
|
match(drv, dev);
|
2007-07-05 16:02:12 +00:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
2007-10-07 12:27:24 +00:00
|
|
|
EXPORT_SYMBOL(register_driver);
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2014-04-07 10:01:20 +00:00
|
|
|
struct resource *dev_get_resource(struct device_d *dev, unsigned long type,
|
|
|
|
int num)
|
2011-07-19 06:34:33 +00:00
|
|
|
{
|
|
|
|
int i, n = 0;
|
|
|
|
|
|
|
|
for (i = 0; i < dev->num_resources; i++) {
|
|
|
|
struct resource *res = &dev->resource[i];
|
2014-04-07 10:01:20 +00:00
|
|
|
if (resource_type(res) == type) {
|
2011-07-19 06:34:33 +00:00
|
|
|
if (n == num)
|
2011-12-01 21:15:00 +00:00
|
|
|
return res;
|
2011-07-19 06:34:33 +00:00
|
|
|
n++;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return NULL;
|
|
|
|
}
|
2011-12-01 21:15:00 +00:00
|
|
|
|
2012-06-22 10:47:22 +00:00
|
|
|
void *dev_get_mem_region(struct device_d *dev, int num)
|
2011-12-01 21:15:00 +00:00
|
|
|
{
|
|
|
|
struct resource *res;
|
|
|
|
|
2014-04-07 10:01:20 +00:00
|
|
|
res = dev_get_resource(dev, IORESOURCE_MEM, num);
|
2011-12-01 21:15:00 +00:00
|
|
|
if (!res)
|
2012-06-22 10:47:22 +00:00
|
|
|
return NULL;
|
2011-12-01 21:15:00 +00:00
|
|
|
|
2012-06-22 10:47:22 +00:00
|
|
|
return (void __force *)res->start;
|
2011-12-01 21:15:00 +00:00
|
|
|
}
|
2011-07-19 06:34:33 +00:00
|
|
|
EXPORT_SYMBOL(dev_get_mem_region);
|
|
|
|
|
2012-10-17 13:05:14 +00:00
|
|
|
struct resource *dev_get_resource_by_name(struct device_d *dev,
|
2014-04-07 10:01:20 +00:00
|
|
|
unsigned long type,
|
2012-10-17 13:05:14 +00:00
|
|
|
const char *name)
|
|
|
|
{
|
|
|
|
int i;
|
|
|
|
|
|
|
|
for (i = 0; i < dev->num_resources; i++) {
|
|
|
|
struct resource *res = &dev->resource[i];
|
2014-04-07 10:01:20 +00:00
|
|
|
if (resource_type(res) != type)
|
2012-10-17 13:05:14 +00:00
|
|
|
continue;
|
|
|
|
if (!res->name)
|
|
|
|
continue;
|
|
|
|
if (!strcmp(name, res->name))
|
|
|
|
return res;
|
|
|
|
}
|
|
|
|
|
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
void *dev_get_mem_region_by_name(struct device_d *dev, const char *name)
|
|
|
|
{
|
|
|
|
struct resource *res;
|
|
|
|
|
2014-04-07 10:01:20 +00:00
|
|
|
res = dev_get_resource_by_name(dev, IORESOURCE_MEM, name);
|
2012-10-17 13:05:14 +00:00
|
|
|
if (!res)
|
|
|
|
return NULL;
|
|
|
|
|
|
|
|
return (void __force *)res->start;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(dev_get_mem_region_by_name);
|
|
|
|
|
|
|
|
void __iomem *dev_request_mem_region_by_name(struct device_d *dev, const char *name)
|
|
|
|
{
|
|
|
|
struct resource *res;
|
|
|
|
|
2014-04-07 10:01:20 +00:00
|
|
|
res = dev_get_resource_by_name(dev, IORESOURCE_MEM, name);
|
2012-10-17 13:05:14 +00:00
|
|
|
if (!res)
|
|
|
|
return NULL;
|
|
|
|
|
|
|
|
res = request_iomem_region(dev_name(dev), res->start, res->end);
|
|
|
|
if (!res)
|
|
|
|
return NULL;
|
|
|
|
|
|
|
|
return (void __force __iomem *)res->start;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(dev_request_mem_region_by_name);
|
|
|
|
|
2011-12-01 21:15:00 +00:00
|
|
|
void __iomem *dev_request_mem_region(struct device_d *dev, int num)
|
|
|
|
{
|
|
|
|
struct resource *res;
|
|
|
|
|
2014-04-07 10:01:20 +00:00
|
|
|
res = dev_get_resource(dev, IORESOURCE_MEM, num);
|
2011-12-01 21:15:00 +00:00
|
|
|
if (!res)
|
|
|
|
return NULL;
|
|
|
|
|
2012-05-24 06:52:22 +00:00
|
|
|
res = request_iomem_region(dev_name(dev), res->start, res->end);
|
2012-06-27 13:15:30 +00:00
|
|
|
if (!res)
|
|
|
|
return NULL;
|
2011-12-01 21:15:00 +00:00
|
|
|
|
|
|
|
return (void __force __iomem *)res->start;
|
|
|
|
}
|
|
|
|
EXPORT_SYMBOL(dev_request_mem_region);
|
|
|
|
|
2007-07-16 08:29:28 +00:00
|
|
|
int dev_protect(struct device_d *dev, size_t count, unsigned long offset, int prot)
|
|
|
|
{
|
2009-04-22 21:39:27 +00:00
|
|
|
printf("%s: currently broken\n", __func__);
|
|
|
|
return -EINVAL;
|
2007-07-16 08:29:28 +00:00
|
|
|
}
|
|
|
|
|
2009-04-22 21:39:27 +00:00
|
|
|
int generic_memmap_ro(struct cdev *cdev, void **map, int flags)
|
2007-07-15 11:50:04 +00:00
|
|
|
{
|
2009-04-22 21:39:27 +00:00
|
|
|
if (!cdev->dev)
|
|
|
|
return -EINVAL;
|
2007-07-15 11:50:04 +00:00
|
|
|
|
|
|
|
if (flags & PROT_WRITE)
|
|
|
|
return -EACCES;
|
2011-07-28 21:05:31 +00:00
|
|
|
*map = dev_get_mem_region(cdev->dev, 0);
|
2007-07-15 11:50:04 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2009-04-22 21:39:27 +00:00
|
|
|
int generic_memmap_rw(struct cdev *cdev, void **map, int flags)
|
2007-07-15 11:50:04 +00:00
|
|
|
{
|
2009-04-22 21:39:27 +00:00
|
|
|
if (!cdev->dev)
|
|
|
|
return -EINVAL;
|
|
|
|
|
2011-07-28 21:05:31 +00:00
|
|
|
*map = dev_get_mem_region(cdev->dev, 0);
|
2007-07-15 11:50:04 +00:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2007-07-05 16:02:12 +00:00
|
|
|
int dummy_probe(struct device_d *dev)
|
|
|
|
{
|
2007-10-11 18:56:18 +00:00
|
|
|
return 0;
|
2007-07-05 16:02:12 +00:00
|
|
|
}
|
2008-08-15 01:33:16 +00:00
|
|
|
EXPORT_SYMBOL(dummy_probe);
|
2007-07-05 16:02:12 +00:00
|
|
|
|
2010-11-01 08:26:15 +00:00
|
|
|
const char *dev_id(const struct device_d *dev)
|
|
|
|
{
|
2011-07-28 06:33:01 +00:00
|
|
|
static char buf[MAX_DRIVER_NAME + 16];
|
2010-11-01 08:26:15 +00:00
|
|
|
|
2012-04-15 14:02:02 +00:00
|
|
|
if (dev->id != DEVICE_ID_SINGLE)
|
|
|
|
snprintf(buf, sizeof(buf), FORMAT_DRIVER_NAME_ID, dev->name, dev->id);
|
|
|
|
else
|
|
|
|
snprintf(buf, sizeof(buf), "%s", dev->name);
|
2010-11-01 08:26:15 +00:00
|
|
|
|
|
|
|
return buf;
|
|
|
|
}
|
|
|
|
|
2013-02-07 12:47:26 +00:00
|
|
|
int dev_printf(int level, const struct device_d *dev, const char *format, ...)
|
2012-09-09 09:37:16 +00:00
|
|
|
{
|
|
|
|
va_list args;
|
|
|
|
int ret = 0;
|
|
|
|
|
2013-02-07 12:47:26 +00:00
|
|
|
if (level > barebox_loglevel)
|
|
|
|
return 0;
|
|
|
|
|
2012-09-09 09:37:16 +00:00
|
|
|
if (dev->driver && dev->driver->name)
|
|
|
|
ret += printf("%s ", dev->driver->name);
|
|
|
|
|
|
|
|
ret += printf("%s: ", dev_name(dev));
|
|
|
|
|
|
|
|
va_start(args, format);
|
|
|
|
|
|
|
|
ret += vprintf(format, args);
|
|
|
|
|
|
|
|
va_end(args);
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2010-11-01 08:26:15 +00:00
|
|
|
void devices_shutdown(void)
|
|
|
|
{
|
|
|
|
struct device_d *dev;
|
|
|
|
|
|
|
|
list_for_each_entry(dev, &active, active) {
|
|
|
|
if (dev->driver->remove)
|
|
|
|
dev->driver->remove(dev);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2012-10-04 08:56:18 +00:00
|
|
|
int dev_get_drvdata(struct device_d *dev, unsigned long *data)
|
|
|
|
{
|
|
|
|
if (dev->of_id_entry) {
|
|
|
|
*data = dev->of_id_entry->data;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (dev->id_entry) {
|
|
|
|
*data = dev->id_entry->driver_data;
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
return -ENODEV;
|
|
|
|
}
|