1 #include <linux/string.h> 2 #include <linux/kernel.h> 3 #include <linux/of.h> 4 #include <linux/of_device.h> 5 #include <linux/init.h> 6 #include <linux/module.h> 7 #include <linux/mod_devicetable.h> 8 #include <linux/slab.h> 9 10 #include <asm/errno.h> 11 12 /** 13 * of_match_device - Tell if an of_device structure has a matching 14 * of_match structure 15 * @ids: array of of device match structures to search in 16 * @dev: the of device structure to match against 17 * 18 * Used by a driver to check whether an of_device present in the 19 * system is in its list of supported devices. 20 */ 21 const struct of_device_id *of_match_device(const struct of_device_id *matches, 22 const struct of_device *dev) 23 { 24 if (!dev->node) 25 return NULL; 26 return of_match_node(matches, dev->node); 27 } 28 EXPORT_SYMBOL(of_match_device); 29 30 struct of_device *of_dev_get(struct of_device *dev) 31 { 32 struct device *tmp; 33 34 if (!dev) 35 return NULL; 36 tmp = get_device(&dev->dev); 37 if (tmp) 38 return to_of_device(tmp); 39 else 40 return NULL; 41 } 42 EXPORT_SYMBOL(of_dev_get); 43 44 void of_dev_put(struct of_device *dev) 45 { 46 if (dev) 47 put_device(&dev->dev); 48 } 49 EXPORT_SYMBOL(of_dev_put); 50 51 static ssize_t devspec_show(struct device *dev, 52 struct device_attribute *attr, char *buf) 53 { 54 struct of_device *ofdev; 55 56 ofdev = to_of_device(dev); 57 return sprintf(buf, "%s\n", ofdev->node->full_name); 58 } 59 60 static ssize_t name_show(struct device *dev, 61 struct device_attribute *attr, char *buf) 62 { 63 struct of_device *ofdev; 64 65 ofdev = to_of_device(dev); 66 return sprintf(buf, "%s\n", ofdev->node->name); 67 } 68 69 static ssize_t modalias_show(struct device *dev, 70 struct device_attribute *attr, char *buf) 71 { 72 struct of_device *ofdev = to_of_device(dev); 73 ssize_t len = 0; 74 75 len = of_device_get_modalias(ofdev, buf, PAGE_SIZE - 2); 76 buf[len] = '\n'; 77 buf[len+1] = 0; 78 return len+1; 79 } 80 81 struct device_attribute of_platform_device_attrs[] = { 82 __ATTR_RO(devspec), 83 __ATTR_RO(name), 84 __ATTR_RO(modalias), 85 __ATTR_NULL 86 }; 87 88 /** 89 * of_release_dev - free an of device structure when all users of it are finished. 90 * @dev: device that's been disconnected 91 * 92 * Will be called only by the device core when all users of this of device are 93 * done. 94 */ 95 void of_release_dev(struct device *dev) 96 { 97 struct of_device *ofdev; 98 99 ofdev = to_of_device(dev); 100 of_node_put(ofdev->node); 101 kfree(ofdev); 102 } 103 EXPORT_SYMBOL(of_release_dev); 104 105 int of_device_register(struct of_device *ofdev) 106 { 107 BUG_ON(ofdev->node == NULL); 108 109 device_initialize(&ofdev->dev); 110 111 /* device_add will assume that this device is on the same node as 112 * the parent. If there is no parent defined, set the node 113 * explicitly */ 114 if (!ofdev->dev.parent) 115 set_dev_node(&ofdev->dev, of_node_to_nid(ofdev->node)); 116 117 return device_add(&ofdev->dev); 118 } 119 EXPORT_SYMBOL(of_device_register); 120 121 void of_device_unregister(struct of_device *ofdev) 122 { 123 device_unregister(&ofdev->dev); 124 } 125 EXPORT_SYMBOL(of_device_unregister); 126 127 ssize_t of_device_get_modalias(struct of_device *ofdev, 128 char *str, ssize_t len) 129 { 130 const char *compat; 131 int cplen, i; 132 ssize_t tsize, csize, repend; 133 134 /* Name & Type */ 135 csize = snprintf(str, len, "of:N%sT%s", 136 ofdev->node->name, ofdev->node->type); 137 138 /* Get compatible property if any */ 139 compat = of_get_property(ofdev->node, "compatible", &cplen); 140 if (!compat) 141 return csize; 142 143 /* Find true end (we tolerate multiple \0 at the end */ 144 for (i = (cplen - 1); i >= 0 && !compat[i]; i--) 145 cplen--; 146 if (!cplen) 147 return csize; 148 cplen++; 149 150 /* Check space (need cplen+1 chars including final \0) */ 151 tsize = csize + cplen; 152 repend = tsize; 153 154 if (csize >= len) /* @ the limit, all is already filled */ 155 return tsize; 156 157 if (tsize >= len) { /* limit compat list */ 158 cplen = len - csize - 1; 159 repend = len; 160 } 161 162 /* Copy and do char replacement */ 163 memcpy(&str[csize + 1], compat, cplen); 164 for (i = csize; i < repend; i++) { 165 char c = str[i]; 166 if (c == '\0') 167 str[i] = 'C'; 168 else if (c == ' ') 169 str[i] = '_'; 170 } 171 172 return tsize; 173 } 174