diff options
-rw-r--r-- | drivers/usb/core/endpoint.c | 238 | ||||
-rw-r--r-- | include/linux/usb.h | 4 |
2 files changed, 153 insertions, 89 deletions
diff --git a/drivers/usb/core/endpoint.c b/drivers/usb/core/endpoint.c index 4c2fe8f723e5..247b5a4913a8 100644 --- a/drivers/usb/core/endpoint.c +++ b/drivers/usb/core/endpoint.c | |||
@@ -14,13 +14,14 @@ | |||
14 | #include "usb.h" | 14 | #include "usb.h" |
15 | 15 | ||
16 | /* endpoint stuff */ | 16 | /* endpoint stuff */ |
17 | struct ep_object { | 17 | |
18 | struct ep_device { | ||
18 | struct usb_endpoint_descriptor *desc; | 19 | struct usb_endpoint_descriptor *desc; |
19 | struct usb_device *udev; | 20 | struct usb_device *udev; |
20 | struct kobject kobj; | 21 | struct device dev; |
21 | }; | 22 | }; |
22 | #define to_ep_object(_kobj) \ | 23 | #define to_ep_device(_dev) \ |
23 | container_of(_kobj, struct ep_object, kobj) | 24 | container_of(_dev, struct ep_device, dev) |
24 | 25 | ||
25 | struct ep_attribute { | 26 | struct ep_attribute { |
26 | struct attribute attr; | 27 | struct attribute attr; |
@@ -30,40 +31,37 @@ struct ep_attribute { | |||
30 | #define to_ep_attribute(_attr) \ | 31 | #define to_ep_attribute(_attr) \ |
31 | container_of(_attr, struct ep_attribute, attr) | 32 | container_of(_attr, struct ep_attribute, attr) |
32 | 33 | ||
33 | #define EP_ATTR(_name) \ | ||
34 | struct ep_attribute ep_##_name = { \ | ||
35 | .attr = {.name = #_name, .owner = THIS_MODULE, \ | ||
36 | .mode = S_IRUGO}, \ | ||
37 | .show = show_ep_##_name} | ||
38 | |||
39 | #define usb_ep_attr(field, format_string) \ | 34 | #define usb_ep_attr(field, format_string) \ |
40 | static ssize_t show_ep_##field(struct usb_device *udev, \ | 35 | static ssize_t show_ep_##field(struct device *dev, \ |
41 | struct usb_endpoint_descriptor *desc, \ | 36 | struct device_attribute *attr, \ |
42 | char *buf) \ | 37 | char *buf) \ |
43 | { \ | 38 | { \ |
44 | return sprintf(buf, format_string, desc->field); \ | 39 | struct ep_device *ep = to_ep_device(dev); \ |
40 | return sprintf(buf, format_string, ep->desc->field); \ | ||
45 | } \ | 41 | } \ |
46 | static EP_ATTR(field); | 42 | static DEVICE_ATTR(field, S_IRUGO, show_ep_##field, NULL); |
47 | 43 | ||
48 | usb_ep_attr(bLength, "%02x\n") | 44 | usb_ep_attr(bLength, "%02x\n") |
49 | usb_ep_attr(bEndpointAddress, "%02x\n") | 45 | usb_ep_attr(bEndpointAddress, "%02x\n") |
50 | usb_ep_attr(bmAttributes, "%02x\n") | 46 | usb_ep_attr(bmAttributes, "%02x\n") |
51 | usb_ep_attr(bInterval, "%02x\n") | 47 | usb_ep_attr(bInterval, "%02x\n") |
52 | 48 | ||
53 | static ssize_t show_ep_wMaxPacketSize(struct usb_device *udev, | 49 | static ssize_t show_ep_wMaxPacketSize(struct device *dev, |
54 | struct usb_endpoint_descriptor *desc, char *buf) | 50 | struct device_attribute *attr, char *buf) |
55 | { | 51 | { |
52 | struct ep_device *ep = to_ep_device(dev); | ||
56 | return sprintf(buf, "%04x\n", | 53 | return sprintf(buf, "%04x\n", |
57 | le16_to_cpu(desc->wMaxPacketSize) & 0x07ff); | 54 | le16_to_cpu(ep->desc->wMaxPacketSize) & 0x07ff); |
58 | } | 55 | } |
59 | static EP_ATTR(wMaxPacketSize); | 56 | static DEVICE_ATTR(wMaxPacketSize, S_IRUGO, show_ep_wMaxPacketSize, NULL); |
60 | 57 | ||
61 | static ssize_t show_ep_type(struct usb_device *udev, | 58 | static ssize_t show_ep_type(struct device *dev, struct device_attribute *attr, |
62 | struct usb_endpoint_descriptor *desc, char *buf) | 59 | char *buf) |
63 | { | 60 | { |
61 | struct ep_device *ep = to_ep_device(dev); | ||
64 | char *type = "unknown"; | 62 | char *type = "unknown"; |
65 | 63 | ||
66 | switch (desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) { | 64 | switch (ep->desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) { |
67 | case USB_ENDPOINT_XFER_CONTROL: | 65 | case USB_ENDPOINT_XFER_CONTROL: |
68 | type = "Control"; | 66 | type = "Control"; |
69 | break; | 67 | break; |
@@ -79,37 +77,38 @@ static ssize_t show_ep_type(struct usb_device *udev, | |||
79 | } | 77 | } |
80 | return sprintf(buf, "%s\n", type); | 78 | return sprintf(buf, "%s\n", type); |
81 | } | 79 | } |
82 | static EP_ATTR(type); | 80 | static DEVICE_ATTR(type, S_IRUGO, show_ep_type, NULL); |
83 | 81 | ||
84 | static ssize_t show_ep_interval(struct usb_device *udev, | 82 | static ssize_t show_ep_interval(struct device *dev, |
85 | struct usb_endpoint_descriptor *desc, char *buf) | 83 | struct device_attribute *attr, char *buf) |
86 | { | 84 | { |
85 | struct ep_device *ep = to_ep_device(dev); | ||
87 | char unit; | 86 | char unit; |
88 | unsigned interval = 0; | 87 | unsigned interval = 0; |
89 | unsigned in; | 88 | unsigned in; |
90 | 89 | ||
91 | in = (desc->bEndpointAddress & USB_DIR_IN); | 90 | in = (ep->desc->bEndpointAddress & USB_DIR_IN); |
92 | 91 | ||
93 | switch (desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) { | 92 | switch (ep->desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) { |
94 | case USB_ENDPOINT_XFER_CONTROL: | 93 | case USB_ENDPOINT_XFER_CONTROL: |
95 | if (udev->speed == USB_SPEED_HIGH) /* uframes per NAK */ | 94 | if (ep->udev->speed == USB_SPEED_HIGH) /* uframes per NAK */ |
96 | interval = desc->bInterval; | 95 | interval = ep->desc->bInterval; |
97 | break; | 96 | break; |
98 | case USB_ENDPOINT_XFER_ISOC: | 97 | case USB_ENDPOINT_XFER_ISOC: |
99 | interval = 1 << (desc->bInterval - 1); | 98 | interval = 1 << (ep->desc->bInterval - 1); |
100 | break; | 99 | break; |
101 | case USB_ENDPOINT_XFER_BULK: | 100 | case USB_ENDPOINT_XFER_BULK: |
102 | if (udev->speed == USB_SPEED_HIGH && !in) /* uframes per NAK */ | 101 | if (ep->udev->speed == USB_SPEED_HIGH && !in) /* uframes per NAK */ |
103 | interval = desc->bInterval; | 102 | interval = ep->desc->bInterval; |
104 | break; | 103 | break; |
105 | case USB_ENDPOINT_XFER_INT: | 104 | case USB_ENDPOINT_XFER_INT: |
106 | if (udev->speed == USB_SPEED_HIGH) | 105 | if (ep->udev->speed == USB_SPEED_HIGH) |
107 | interval = 1 << (desc->bInterval - 1); | 106 | interval = 1 << (ep->desc->bInterval - 1); |
108 | else | 107 | else |
109 | interval = desc->bInterval; | 108 | interval = ep->desc->bInterval; |
110 | break; | 109 | break; |
111 | } | 110 | } |
112 | interval *= (udev->speed == USB_SPEED_HIGH) ? 125 : 1000; | 111 | interval *= (ep->udev->speed == USB_SPEED_HIGH) ? 125 : 1000; |
113 | if (interval % 1000) | 112 | if (interval % 1000) |
114 | unit = 'u'; | 113 | unit = 'u'; |
115 | else { | 114 | else { |
@@ -119,95 +118,158 @@ static ssize_t show_ep_interval(struct usb_device *udev, | |||
119 | 118 | ||
120 | return sprintf(buf, "%d%cs\n", interval, unit); | 119 | return sprintf(buf, "%d%cs\n", interval, unit); |
121 | } | 120 | } |
122 | static EP_ATTR(interval); | 121 | static DEVICE_ATTR(interval, S_IRUGO, show_ep_interval, NULL); |
123 | 122 | ||
124 | static ssize_t show_ep_direction(struct usb_device *udev, | 123 | static ssize_t show_ep_direction(struct device *dev, |
125 | struct usb_endpoint_descriptor *desc, char *buf) | 124 | struct device_attribute *attr, char *buf) |
126 | { | 125 | { |
126 | struct ep_device *ep = to_ep_device(dev); | ||
127 | char *direction; | 127 | char *direction; |
128 | 128 | ||
129 | if ((desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == | 129 | if ((ep->desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) == |
130 | USB_ENDPOINT_XFER_CONTROL) | 130 | USB_ENDPOINT_XFER_CONTROL) |
131 | direction = "both"; | 131 | direction = "both"; |
132 | else if (desc->bEndpointAddress & USB_DIR_IN) | 132 | else if (ep->desc->bEndpointAddress & USB_DIR_IN) |
133 | direction = "in"; | 133 | direction = "in"; |
134 | else | 134 | else |
135 | direction = "out"; | 135 | direction = "out"; |
136 | return sprintf(buf, "%s\n", direction); | 136 | return sprintf(buf, "%s\n", direction); |
137 | } | 137 | } |
138 | static EP_ATTR(direction); | 138 | static DEVICE_ATTR(direction, S_IRUGO, show_ep_direction, NULL); |
139 | 139 | ||
140 | static struct attribute *ep_attrs[] = { | 140 | static struct attribute *ep_dev_attrs[] = { |
141 | &ep_bLength.attr, | 141 | &dev_attr_bLength.attr, |
142 | &ep_bEndpointAddress.attr, | 142 | &dev_attr_bEndpointAddress.attr, |
143 | &ep_bmAttributes.attr, | 143 | &dev_attr_bmAttributes.attr, |
144 | &ep_bInterval.attr, | 144 | &dev_attr_bInterval.attr, |
145 | &ep_wMaxPacketSize.attr, | 145 | &dev_attr_wMaxPacketSize.attr, |
146 | &ep_type.attr, | 146 | &dev_attr_interval.attr, |
147 | &ep_interval.attr, | 147 | &dev_attr_type.attr, |
148 | &ep_direction.attr, | 148 | &dev_attr_direction.attr, |
149 | NULL, | 149 | NULL, |
150 | }; | 150 | }; |
151 | static struct attribute_group ep_dev_attr_grp = { | ||
152 | .attrs = ep_dev_attrs, | ||
153 | }; | ||
151 | 154 | ||
152 | static void ep_object_release(struct kobject *kobj) | 155 | static struct endpoint_class { |
156 | struct kref kref; | ||
157 | struct class *class; | ||
158 | } *ep_class; | ||
159 | |||
160 | static int init_endpoint_class(void) | ||
153 | { | 161 | { |
154 | kfree(to_ep_object(kobj)); | 162 | int result = 0; |
163 | |||
164 | if (ep_class != NULL) { | ||
165 | kref_get(&ep_class->kref); | ||
166 | goto exit; | ||
167 | } | ||
168 | |||
169 | ep_class = kmalloc(sizeof(*ep_class), GFP_KERNEL); | ||
170 | if (!ep_class) { | ||
171 | result = -ENOMEM; | ||
172 | goto exit; | ||
173 | } | ||
174 | |||
175 | kref_init(&ep_class->kref); | ||
176 | ep_class->class = class_create(THIS_MODULE, "usb_endpoint"); | ||
177 | if (IS_ERR(ep_class->class)) { | ||
178 | result = IS_ERR(ep_class->class); | ||
179 | kfree(ep_class); | ||
180 | ep_class = NULL; | ||
181 | goto exit; | ||
182 | } | ||
183 | |||
184 | exit: | ||
185 | return result; | ||
155 | } | 186 | } |
156 | 187 | ||
157 | static ssize_t ep_object_show(struct kobject *kobj, struct attribute *attr, | 188 | static void release_endpoint_class(struct kref *kref) |
158 | char *buf) | ||
159 | { | 189 | { |
160 | struct ep_object *ep_obj = to_ep_object(kobj); | 190 | /* Ok, we cheat as we know we only have one ep_class */ |
161 | struct ep_attribute *ep_attr = to_ep_attribute(attr); | 191 | class_destroy(ep_class->class); |
192 | kfree(ep_class); | ||
193 | ep_class = NULL; | ||
194 | } | ||
162 | 195 | ||
163 | return (ep_attr->show)(ep_obj->udev, ep_obj->desc, buf); | 196 | static void destroy_endpoint_class(void) |
197 | { | ||
198 | if (ep_class) | ||
199 | kref_put(&ep_class->kref, release_endpoint_class); | ||
164 | } | 200 | } |
165 | 201 | ||
166 | static struct sysfs_ops ep_object_sysfs_ops = { | 202 | static void ep_device_release(struct device *dev) |
167 | .show = ep_object_show, | 203 | { |
168 | }; | 204 | struct ep_device *ep_dev = to_ep_device(dev); |
169 | 205 | ||
170 | static struct kobj_type ep_object_ktype = { | 206 | dev_dbg(dev, "%s called for %s\n", __FUNCTION__, dev->bus_id); |
171 | .release = ep_object_release, | 207 | kfree(ep_dev); |
172 | .sysfs_ops = &ep_object_sysfs_ops, | 208 | } |
173 | .default_attrs = ep_attrs, | ||
174 | }; | ||
175 | 209 | ||
176 | void usb_create_ep_files(struct device *parent, | 210 | void usb_create_ep_files(struct device *parent, |
177 | struct usb_host_endpoint *endpoint, | 211 | struct usb_host_endpoint *endpoint, |
178 | struct usb_device *udev) | 212 | struct usb_device *udev) |
179 | { | 213 | { |
180 | struct ep_object *ep_obj; | 214 | char name[8]; |
181 | struct kobject *kobj; | 215 | struct ep_device *ep_dev; |
216 | int minor; | ||
217 | int retval; | ||
218 | |||
219 | retval = init_endpoint_class(); | ||
220 | if (retval) | ||
221 | goto exit; | ||
182 | 222 | ||
183 | ep_obj = kzalloc(sizeof(struct ep_object), GFP_KERNEL); | 223 | ep_dev = kzalloc(sizeof(*ep_dev), GFP_KERNEL); |
184 | if (!ep_obj) | 224 | if (!ep_dev) { |
185 | return; | 225 | retval = -ENOMEM; |
226 | goto exit; | ||
227 | } | ||
186 | 228 | ||
187 | ep_obj->desc = &endpoint->desc; | 229 | /* fun calculation to determine the minor of this endpoint */ |
188 | ep_obj->udev = udev; | 230 | minor = (((udev->bus->busnum - 1) * 128) * 16) + (udev->devnum - 1); |
189 | 231 | ||
190 | kobj = &ep_obj->kobj; | 232 | ep_dev->desc = &endpoint->desc; |
191 | kobject_set_name(kobj, "ep_%02x", endpoint->desc.bEndpointAddress); | 233 | ep_dev->udev = udev; |
192 | kobj->parent = &parent->kobj; | 234 | ep_dev->dev.devt = MKDEV(442, minor); // FIXME fake number... |
193 | kobj->ktype = &ep_object_ktype; | 235 | ep_dev->dev.class = ep_class->class; |
236 | ep_dev->dev.parent = parent; | ||
237 | ep_dev->dev.release = ep_device_release; | ||
238 | snprintf(ep_dev->dev.bus_id, BUS_ID_SIZE, "usbdev%d.%d_ep%02x", | ||
239 | udev->bus->busnum, udev->devnum, | ||
240 | endpoint->desc.bEndpointAddress); | ||
194 | 241 | ||
195 | /* Don't use kobject_register, because it generates a hotplug event */ | 242 | retval = device_register(&ep_dev->dev); |
196 | kobject_init(kobj); | 243 | if (retval) |
197 | if (kobject_add(kobj) == 0) | 244 | goto error; |
198 | endpoint->kobj = kobj; | 245 | sysfs_create_group(&ep_dev->dev.kobj, &ep_dev_attr_grp); |
199 | else | 246 | |
200 | kobject_put(kobj); | 247 | endpoint->ep_dev = ep_dev; |
248 | |||
249 | /* create the symlink to the old-style "ep_XX" directory */ | ||
250 | sprintf(name, "ep_%02x", endpoint->desc.bEndpointAddress); | ||
251 | sysfs_create_link(&parent->kobj, &endpoint->ep_dev->dev.kobj, name); | ||
252 | |||
253 | exit: | ||
254 | return; | ||
255 | error: | ||
256 | kfree(ep_dev); | ||
257 | return; | ||
201 | } | 258 | } |
202 | 259 | ||
203 | void usb_remove_ep_files(struct usb_host_endpoint *endpoint) | 260 | void usb_remove_ep_files(struct usb_host_endpoint *endpoint) |
204 | { | 261 | { |
205 | 262 | ||
206 | if (endpoint->kobj) { | 263 | if (endpoint->ep_dev) { |
207 | kobject_del(endpoint->kobj); | 264 | char name[8]; |
208 | kobject_put(endpoint->kobj); | 265 | |
209 | endpoint->kobj = NULL; | 266 | sprintf(name, "ep_%02x", endpoint->desc.bEndpointAddress); |
267 | sysfs_remove_link(&endpoint->ep_dev->dev.parent->kobj, name); | ||
268 | sysfs_remove_group(&endpoint->ep_dev->dev.kobj, &ep_dev_attr_grp); | ||
269 | device_unregister(&endpoint->ep_dev->dev); | ||
270 | endpoint->ep_dev = NULL; | ||
210 | } | 271 | } |
272 | destroy_endpoint_class(); | ||
211 | } | 273 | } |
212 | 274 | ||
213 | 275 | ||
diff --git a/include/linux/usb.h b/include/linux/usb.h index 5ad30cefe7b2..46956a72de5d 100644 --- a/include/linux/usb.h +++ b/include/linux/usb.h | |||
@@ -40,6 +40,8 @@ struct usb_driver; | |||
40 | * Devices may also have class-specific or vendor-specific descriptors. | 40 | * Devices may also have class-specific or vendor-specific descriptors. |
41 | */ | 41 | */ |
42 | 42 | ||
43 | struct ep_device; | ||
44 | |||
43 | /** | 45 | /** |
44 | * struct usb_host_endpoint - host-side endpoint descriptor and queue | 46 | * struct usb_host_endpoint - host-side endpoint descriptor and queue |
45 | * @desc: descriptor for this endpoint, wMaxPacketSize in native byteorder | 47 | * @desc: descriptor for this endpoint, wMaxPacketSize in native byteorder |
@@ -57,7 +59,7 @@ struct usb_host_endpoint { | |||
57 | struct usb_endpoint_descriptor desc; | 59 | struct usb_endpoint_descriptor desc; |
58 | struct list_head urb_list; | 60 | struct list_head urb_list; |
59 | void *hcpriv; | 61 | void *hcpriv; |
60 | struct kobject *kobj; /* For sysfs info */ | 62 | struct ep_device *ep_dev; /* For sysfs info */ |
61 | 63 | ||
62 | unsigned char *extra; /* Extra descriptors */ | 64 | unsigned char *extra; /* Extra descriptors */ |
63 | int extralen; | 65 | int extralen; |