129 lines · 3.0 KB · C
RawDownload
#include <linux/string.h>#include <linux/kernel.h>#include <linux/init.h>#include <linux/module.h>#include <linux/mod_devicetable.h>#include <linux/slab.h> #include <asm/errno.h>#include <asm/of_device.h> /** * of_match_node - Tell if an device_node has a matching of_match structure * @ids: array of of device match structures to search in * @node: the of device structure to match against * * Low level utility function used by device matching. */const struct of_device_id *of_match_node(const struct of_device_id *matches,					 const struct device_node *node){	while (matches->name[0] || matches->type[0] || matches->compatible[0]) {		int match = 1;		if (matches->name[0])			match &= node->name				&& !strcmp(matches->name, node->name);		if (matches->type[0])			match &= node->type				&& !strcmp(matches->type, node->type);		if (matches->compatible[0])			match &= device_is_compatible(node,						      matches->compatible);		if (match)			return matches;		matches++;	}	return NULL;} /** * of_match_device - Tell if an of_device structure has a matching * of_match structure * @ids: array of of device match structures to search in * @dev: the of device structure to match against * * Used by a driver to check whether an of_device present in the * system is in its list of supported devices. */const struct of_device_id *of_match_device(const struct of_device_id *matches,					const struct of_device *dev){	if (!dev->node)		return NULL;	return of_match_node(matches, dev->node);} struct of_device *of_dev_get(struct of_device *dev){	struct device *tmp; 	if (!dev)		return NULL;	tmp = get_device(&dev->dev);	if (tmp)		return to_of_device(tmp);	else		return NULL;} void of_dev_put(struct of_device *dev){	if (dev)		put_device(&dev->dev);} static ssize_t dev_show_devspec(struct device *dev,				struct device_attribute *attr, char *buf){	struct of_device *ofdev; 	ofdev = to_of_device(dev);	return sprintf(buf, "%s", ofdev->node->full_name);} static DEVICE_ATTR(devspec, S_IRUGO, dev_show_devspec, NULL); /** * of_release_dev - free an of device structure when all users of it are finished. * @dev: device that's been disconnected * * Will be called only by the device core when all users of this of device are * done. */void of_release_dev(struct device *dev){	struct of_device *ofdev;         ofdev = to_of_device(dev);	of_node_put(ofdev->node);	kfree(ofdev);} int of_device_register(struct of_device *ofdev){	int rc; 	BUG_ON(ofdev->node == NULL); 	rc = device_register(&ofdev->dev);	if (rc)		return rc; 	return device_create_file(&ofdev->dev, &dev_attr_devspec);} void of_device_unregister(struct of_device *ofdev){	device_remove_file(&ofdev->dev, &dev_attr_devspec); 	device_unregister(&ofdev->dev);}  EXPORT_SYMBOL(of_match_node);EXPORT_SYMBOL(of_match_device);EXPORT_SYMBOL(of_device_register);EXPORT_SYMBOL(of_device_unregister);EXPORT_SYMBOL(of_dev_get);EXPORT_SYMBOL(of_dev_put);EXPORT_SYMBOL(of_release_dev);