Lines Matching +full:device +full:- +full:id
2 * Industry-pack bus support functions.
4 * Copyright (C) 2011-2012 CERN (www.cern.ch)
18 #define to_ipack_dev(device) container_of(device, struct ipack_device, dev) argument
23 static void ipack_device_release(struct device *dev) in ipack_device_release()
25 struct ipack_device *device = to_ipack_dev(dev); in ipack_device_release() local
26 kfree(device->id); in ipack_device_release()
27 device->release(device); in ipack_device_release()
31 ipack_match_one_device(const struct ipack_device_id *id, in ipack_match_one_device() argument
32 const struct ipack_device *device) in ipack_match_one_device() argument
34 if ((id->format == IPACK_ANY_FORMAT || in ipack_match_one_device()
35 id->format == device->id_format) && in ipack_match_one_device()
36 (id->vendor == IPACK_ANY_ID || id->vendor == device->id_vendor) && in ipack_match_one_device()
37 (id->device == IPACK_ANY_ID || id->device == device->id_device)) in ipack_match_one_device()
38 return id; in ipack_match_one_device()
46 while (ids->vendor || ids->device) { in ipack_match_id()
55 static int ipack_bus_match(struct device *dev, struct device_driver *drv) in ipack_bus_match()
61 found_id = ipack_match_id(idrv->id_table, idev); in ipack_bus_match()
65 static int ipack_bus_probe(struct device *device) in ipack_bus_probe() argument
67 struct ipack_device *dev = to_ipack_dev(device); in ipack_bus_probe()
68 struct ipack_driver *drv = to_ipack_driver(device->driver); in ipack_bus_probe()
70 if (!drv->ops->probe) in ipack_bus_probe()
71 return -EINVAL; in ipack_bus_probe()
73 return drv->ops->probe(dev); in ipack_bus_probe()
76 static int ipack_bus_remove(struct device *device) in ipack_bus_remove() argument
78 struct ipack_device *dev = to_ipack_dev(device); in ipack_bus_remove()
79 struct ipack_driver *drv = to_ipack_driver(device->driver); in ipack_bus_remove()
81 if (!drv->ops->remove) in ipack_bus_remove()
82 return -EINVAL; in ipack_bus_remove()
84 drv->ops->remove(dev); in ipack_bus_remove()
88 static int ipack_uevent(struct device *dev, struct kobj_uevent_env *env) in ipack_uevent()
93 return -ENODEV; in ipack_uevent()
98 "MODALIAS=ipack:f%02Xv%08Xd%08X", idev->id_format, in ipack_uevent()
99 idev->id_vendor, idev->id_device)) in ipack_uevent()
100 return -ENOMEM; in ipack_uevent()
107 field##_show(struct device *dev, struct device_attribute *attr, \
111 return sprintf(buf, format_string, idev->field); \
114 static ssize_t id_show(struct device *dev, in id_show()
121 switch (idev->id_format) { in id_show()
127 return -EIO; in id_show()
130 for (i = 0; i < idev->id_avail; i++) { in id_show()
137 sprintf(&buf[c], "%02x", idev->id[i]); in id_show()
145 id_vendor_show(struct device *dev, struct device_attribute *attr, char *buf) in id_vendor_show()
148 switch (idev->id_format) { in id_vendor_show()
150 return sprintf(buf, "0x%02x\n", idev->id_vendor); in id_vendor_show()
152 return sprintf(buf, "0x%06x\n", idev->id_vendor); in id_vendor_show()
154 return -EIO; in id_vendor_show()
159 id_device_show(struct device *dev, struct device_attribute *attr, char *buf) in id_device_show()
162 switch (idev->id_format) { in id_device_show()
164 return sprintf(buf, "0x%02x\n", idev->id_device); in id_device_show()
166 return sprintf(buf, "0x%04x\n", idev->id_device); in id_device_show()
168 return -EIO; in id_device_show()
172 static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, in modalias_show()
177 return sprintf(buf, "ipac:f%02Xv%08Xd%08X", idev->id_format, in modalias_show()
178 idev->id_vendor, idev->id_device); in modalias_show()
183 static DEVICE_ATTR_RO(id);
208 struct ipack_bus_device *ipack_bus_register(struct device *parent, int slots, in ipack_bus_register()
225 bus->bus_nr = bus_nr; in ipack_bus_register()
226 bus->parent = parent; in ipack_bus_register()
227 bus->slots = slots; in ipack_bus_register()
228 bus->ops = ops; in ipack_bus_register()
229 bus->owner = owner; in ipack_bus_register()
234 static int ipack_unregister_bus_member(struct device *dev, void *data) in ipack_unregister_bus_member()
239 if (idev->bus == bus) in ipack_unregister_bus_member()
249 ida_simple_remove(&ipack_ida, bus->bus_nr); in ipack_bus_unregister()
258 edrv->driver.owner = owner; in ipack_driver_register()
259 edrv->driver.name = name; in ipack_driver_register()
260 edrv->driver.bus = &ipack_bus_type; in ipack_driver_register()
261 return driver_register(&edrv->driver); in ipack_driver_register()
267 driver_unregister(&edrv->driver); in ipack_driver_unregister()
282 * The algorithm in lib/crc-ccitt.c does not seem to apply since it uses the
292 for (i = 0; i < dev->id_avail; i++) { in ipack_calc_crc1()
293 c = (i != 11) ? dev->id[i] : 0; in ipack_calc_crc1()
307 for (i = 0; i < dev->id_avail; i++) { in ipack_calc_crc2()
308 c = ((i != 0x18) && (i != 0x19)) ? dev->id[i] : 0; in ipack_calc_crc2()
317 u8 *id = dev->id; in ipack_parse_id1() local
320 dev->id_vendor = id[4]; in ipack_parse_id1()
321 dev->id_device = id[5]; in ipack_parse_id1()
322 dev->speed_8mhz = 1; in ipack_parse_id1()
323 dev->speed_32mhz = (id[7] == 'H'); in ipack_parse_id1()
325 dev->id_crc_correct = (crc == id[11]); in ipack_parse_id1()
326 if (!dev->id_crc_correct) { in ipack_parse_id1()
327 dev_warn(&dev->dev, "ID CRC invalid found 0x%x, expected 0x%x.\n", in ipack_parse_id1()
328 id[11], crc); in ipack_parse_id1()
334 __be16 *id = (__be16 *) dev->id; in ipack_parse_id2() local
337 dev->id_vendor = ((be16_to_cpu(id[3]) & 0xff) << 16) in ipack_parse_id2()
338 + be16_to_cpu(id[4]); in ipack_parse_id2()
339 dev->id_device = be16_to_cpu(id[5]); in ipack_parse_id2()
340 flags = be16_to_cpu(id[10]); in ipack_parse_id2()
341 dev->speed_8mhz = !!(flags & 2); in ipack_parse_id2()
342 dev->speed_32mhz = !!(flags & 4); in ipack_parse_id2()
344 dev->id_crc_correct = (crc == be16_to_cpu(id[12])); in ipack_parse_id2()
345 if (!dev->id_crc_correct) { in ipack_parse_id2()
346 dev_warn(&dev->dev, "ID CRC invalid found 0x%x, expected 0x%x.\n", in ipack_parse_id2()
347 id[11], crc); in ipack_parse_id2()
357 idmem = ioremap(dev->region[IPACK_ID_SPACE].start, in ipack_device_read_id()
358 dev->region[IPACK_ID_SPACE].size); in ipack_device_read_id()
360 dev_err(&dev->dev, "error mapping memory\n"); in ipack_device_read_id()
361 return -ENOMEM; in ipack_device_read_id()
364 /* Determine ID PROM Data Format. If we find the ids "IPAC" or "IPAH" in ipack_device_read_id()
365 * we are dealing with a IndustryPack format 1 device. If we detect in ipack_device_read_id()
367 * IndustryPack format 2 device */ in ipack_device_read_id()
373 dev->id_format = IPACK_ID_VERSION_1; in ipack_device_read_id()
374 dev->id_avail = ioread8(idmem + 0x15); in ipack_device_read_id()
375 if ((dev->id_avail < 0x0c) || (dev->id_avail > 0x40)) { in ipack_device_read_id()
376 dev_warn(&dev->dev, "invalid id size"); in ipack_device_read_id()
377 dev->id_avail = 0x0c; in ipack_device_read_id()
385 dev->id_format = IPACK_ID_VERSION_2; in ipack_device_read_id()
386 dev->id_avail = ioread16be(idmem + 0x16); in ipack_device_read_id()
387 if ((dev->id_avail < 0x1a) || (dev->id_avail > 0x40)) { in ipack_device_read_id()
388 dev_warn(&dev->dev, "invalid id size"); in ipack_device_read_id()
389 dev->id_avail = 0x1a; in ipack_device_read_id()
392 dev->id_format = IPACK_ID_VERSION_INVALID; in ipack_device_read_id()
393 dev->id_avail = 0; in ipack_device_read_id()
396 if (!dev->id_avail) { in ipack_device_read_id()
397 ret = -ENODEV; in ipack_device_read_id()
402 * ID ROM contents */ in ipack_device_read_id()
403 dev->id = kmalloc(dev->id_avail, GFP_KERNEL); in ipack_device_read_id()
404 if (!dev->id) { in ipack_device_read_id()
405 ret = -ENOMEM; in ipack_device_read_id()
408 for (i = 0; i < dev->id_avail; i++) { in ipack_device_read_id()
409 if (dev->id_format == IPACK_ID_VERSION_1) in ipack_device_read_id()
410 dev->id[i] = ioread8(idmem + (i << 1) + 1); in ipack_device_read_id()
412 dev->id[i] = ioread8(idmem + i); in ipack_device_read_id()
416 switch (dev->id_format) { in ipack_device_read_id()
435 dev->dev.bus = &ipack_bus_type; in ipack_device_init()
436 dev->dev.release = ipack_device_release; in ipack_device_init()
437 dev->dev.parent = dev->bus->parent; in ipack_device_init()
438 dev_set_name(&dev->dev, in ipack_device_init()
439 "ipack-dev.%u.%u", dev->bus->bus_nr, dev->slot); in ipack_device_init()
440 device_initialize(&dev->dev); in ipack_device_init()
442 if (dev->bus->ops->set_clockrate(dev, 8)) in ipack_device_init()
443 dev_warn(&dev->dev, "failed to switch to 8 MHz operation for reading of device ID.\n"); in ipack_device_init()
444 if (dev->bus->ops->reset_timeout(dev)) in ipack_device_init()
445 dev_warn(&dev->dev, "failed to reset potential timeout."); in ipack_device_init()
449 dev_err(&dev->dev, "error reading device id section.\n"); in ipack_device_init()
453 /* if the device supports 32 MHz operation, use it. */ in ipack_device_init()
454 if (dev->speed_32mhz) { in ipack_device_init()
455 ret = dev->bus->ops->set_clockrate(dev, 32); in ipack_device_init()
457 dev_err(&dev->dev, "failed to switch to 32 MHz operation.\n"); in ipack_device_init()
466 return device_add(&dev->dev); in ipack_device_add()
472 device_del(&dev->dev); in ipack_device_del()
479 get_device(&dev->dev); in ipack_get_device()
485 put_device(&dev->dev); in ipack_put_device()
506 MODULE_DESCRIPTION("Industry-pack bus core");