Lines Matching +full:device +full:- +full:id

1 // SPDX-License-Identifier: GPL-2.0-only
3 * Industry-pack bus support functions.
5 * Copyright (C) 2011-2012 CERN (www.cern.ch)
15 #define to_ipack_dev(device) container_of(device, struct ipack_device, dev) argument
20 static void ipack_device_release(struct device *dev) in ipack_device_release()
22 struct ipack_device *device = to_ipack_dev(dev); in ipack_device_release() local
23 kfree(device->id); in ipack_device_release()
24 device->release(device); in ipack_device_release()
28 ipack_match_one_device(const struct ipack_device_id *id, in ipack_match_one_device() argument
29 const struct ipack_device *device) in ipack_match_one_device() argument
31 if ((id->format == IPACK_ANY_FORMAT || in ipack_match_one_device()
32 id->format == device->id_format) && in ipack_match_one_device()
33 (id->vendor == IPACK_ANY_ID || id->vendor == device->id_vendor) && in ipack_match_one_device()
34 (id->device == IPACK_ANY_ID || id->device == device->id_device)) in ipack_match_one_device()
35 return id; in ipack_match_one_device()
43 while (ids->vendor || ids->device) { in ipack_match_id()
52 static int ipack_bus_match(struct device *dev, struct device_driver *drv) in ipack_bus_match()
58 found_id = ipack_match_id(idrv->id_table, idev); in ipack_bus_match()
62 static int ipack_bus_probe(struct device *device) in ipack_bus_probe() argument
64 struct ipack_device *dev = to_ipack_dev(device); in ipack_bus_probe()
65 struct ipack_driver *drv = to_ipack_driver(device->driver); in ipack_bus_probe()
67 return drv->ops->probe(dev); in ipack_bus_probe()
70 static void ipack_bus_remove(struct device *device) in ipack_bus_remove() argument
72 struct ipack_device *dev = to_ipack_dev(device); in ipack_bus_remove()
73 struct ipack_driver *drv = to_ipack_driver(device->driver); in ipack_bus_remove()
75 if (drv->ops->remove) in ipack_bus_remove()
76 drv->ops->remove(dev); in ipack_bus_remove()
79 static int ipack_uevent(struct device *dev, struct kobj_uevent_env *env) in ipack_uevent()
84 return -ENODEV; in ipack_uevent()
89 "MODALIAS=ipack:f%02Xv%08Xd%08X", idev->id_format, in ipack_uevent()
90 idev->id_vendor, idev->id_device)) in ipack_uevent()
91 return -ENOMEM; in ipack_uevent()
98 field##_show(struct device *dev, struct device_attribute *attr, \
102 return sprintf(buf, format_string, idev->field); \
105 static ssize_t id_show(struct device *dev, in id_show()
112 switch (idev->id_format) { in id_show()
118 return -EIO; in id_show()
121 for (i = 0; i < idev->id_avail; i++) { in id_show()
128 sprintf(&buf[c], "%02x", idev->id[i]); in id_show()
136 id_vendor_show(struct device *dev, struct device_attribute *attr, char *buf) in id_vendor_show()
139 switch (idev->id_format) { in id_vendor_show()
141 return sprintf(buf, "0x%02x\n", idev->id_vendor); in id_vendor_show()
143 return sprintf(buf, "0x%06x\n", idev->id_vendor); in id_vendor_show()
145 return -EIO; in id_vendor_show()
150 id_device_show(struct device *dev, struct device_attribute *attr, char *buf) in id_device_show()
153 switch (idev->id_format) { in id_device_show()
155 return sprintf(buf, "0x%02x\n", idev->id_device); in id_device_show()
157 return sprintf(buf, "0x%04x\n", idev->id_device); in id_device_show()
159 return -EIO; in id_device_show()
163 static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, in modalias_show()
168 return sprintf(buf, "ipac:f%02Xv%08Xd%08X", idev->id_format, in modalias_show()
169 idev->id_vendor, idev->id_device); in modalias_show()
174 static DEVICE_ATTR_RO(id);
199 struct ipack_bus_device *ipack_bus_register(struct device *parent, int slots, in ipack_bus_register()
216 bus->bus_nr = bus_nr; in ipack_bus_register()
217 bus->parent = parent; in ipack_bus_register()
218 bus->slots = slots; in ipack_bus_register()
219 bus->ops = ops; in ipack_bus_register()
220 bus->owner = owner; in ipack_bus_register()
225 static int ipack_unregister_bus_member(struct device *dev, void *data) in ipack_unregister_bus_member()
230 if (idev->bus == bus) in ipack_unregister_bus_member()
240 ida_simple_remove(&ipack_ida, bus->bus_nr); in ipack_bus_unregister()
249 if (!edrv->ops->probe) in ipack_driver_register()
250 return -EINVAL; in ipack_driver_register()
252 edrv->driver.owner = owner; in ipack_driver_register()
253 edrv->driver.name = name; in ipack_driver_register()
254 edrv->driver.bus = &ipack_bus_type; in ipack_driver_register()
255 return driver_register(&edrv->driver); in ipack_driver_register()
261 driver_unregister(&edrv->driver); in ipack_driver_unregister()
276 * The algorithm in lib/crc-ccitt.c does not seem to apply since it uses the
286 for (i = 0; i < dev->id_avail; i++) { in ipack_calc_crc1()
287 c = (i != 11) ? dev->id[i] : 0; in ipack_calc_crc1()
301 for (i = 0; i < dev->id_avail; i++) { in ipack_calc_crc2()
302 c = ((i != 0x18) && (i != 0x19)) ? dev->id[i] : 0; in ipack_calc_crc2()
311 u8 *id = dev->id; in ipack_parse_id1() local
314 dev->id_vendor = id[4]; in ipack_parse_id1()
315 dev->id_device = id[5]; in ipack_parse_id1()
316 dev->speed_8mhz = 1; in ipack_parse_id1()
317 dev->speed_32mhz = (id[7] == 'H'); in ipack_parse_id1()
319 dev->id_crc_correct = (crc == id[11]); in ipack_parse_id1()
320 if (!dev->id_crc_correct) { in ipack_parse_id1()
321 dev_warn(&dev->dev, "ID CRC invalid found 0x%x, expected 0x%x.\n", in ipack_parse_id1()
322 id[11], crc); in ipack_parse_id1()
328 __be16 *id = (__be16 *) dev->id; in ipack_parse_id2() local
331 dev->id_vendor = ((be16_to_cpu(id[3]) & 0xff) << 16) in ipack_parse_id2()
332 + be16_to_cpu(id[4]); in ipack_parse_id2()
333 dev->id_device = be16_to_cpu(id[5]); in ipack_parse_id2()
334 flags = be16_to_cpu(id[10]); in ipack_parse_id2()
335 dev->speed_8mhz = !!(flags & 2); in ipack_parse_id2()
336 dev->speed_32mhz = !!(flags & 4); in ipack_parse_id2()
338 dev->id_crc_correct = (crc == be16_to_cpu(id[12])); in ipack_parse_id2()
339 if (!dev->id_crc_correct) { in ipack_parse_id2()
340 dev_warn(&dev->dev, "ID CRC invalid found 0x%x, expected 0x%x.\n", in ipack_parse_id2()
341 id[11], crc); in ipack_parse_id2()
351 idmem = ioremap(dev->region[IPACK_ID_SPACE].start, in ipack_device_read_id()
352 dev->region[IPACK_ID_SPACE].size); in ipack_device_read_id()
354 dev_err(&dev->dev, "error mapping memory\n"); in ipack_device_read_id()
355 return -ENOMEM; in ipack_device_read_id()
358 /* Determine ID PROM Data Format. If we find the ids "IPAC" or "IPAH" in ipack_device_read_id()
359 * we are dealing with a IndustryPack format 1 device. If we detect in ipack_device_read_id()
361 * IndustryPack format 2 device */ in ipack_device_read_id()
367 dev->id_format = IPACK_ID_VERSION_1; in ipack_device_read_id()
368 dev->id_avail = ioread8(idmem + 0x15); in ipack_device_read_id()
369 if ((dev->id_avail < 0x0c) || (dev->id_avail > 0x40)) { in ipack_device_read_id()
370 dev_warn(&dev->dev, "invalid id size"); in ipack_device_read_id()
371 dev->id_avail = 0x0c; in ipack_device_read_id()
379 dev->id_format = IPACK_ID_VERSION_2; in ipack_device_read_id()
380 dev->id_avail = ioread16be(idmem + 0x16); in ipack_device_read_id()
381 if ((dev->id_avail < 0x1a) || (dev->id_avail > 0x40)) { in ipack_device_read_id()
382 dev_warn(&dev->dev, "invalid id size"); in ipack_device_read_id()
383 dev->id_avail = 0x1a; in ipack_device_read_id()
386 dev->id_format = IPACK_ID_VERSION_INVALID; in ipack_device_read_id()
387 dev->id_avail = 0; in ipack_device_read_id()
390 if (!dev->id_avail) { in ipack_device_read_id()
391 ret = -ENODEV; in ipack_device_read_id()
396 * ID ROM contents */ in ipack_device_read_id()
397 dev->id = kmalloc(dev->id_avail, GFP_KERNEL); in ipack_device_read_id()
398 if (!dev->id) { in ipack_device_read_id()
399 ret = -ENOMEM; in ipack_device_read_id()
402 for (i = 0; i < dev->id_avail; i++) { in ipack_device_read_id()
403 if (dev->id_format == IPACK_ID_VERSION_1) in ipack_device_read_id()
404 dev->id[i] = ioread8(idmem + (i << 1) + 1); in ipack_device_read_id()
406 dev->id[i] = ioread8(idmem + i); in ipack_device_read_id()
410 switch (dev->id_format) { in ipack_device_read_id()
429 dev->dev.bus = &ipack_bus_type; in ipack_device_init()
430 dev->dev.release = ipack_device_release; in ipack_device_init()
431 dev->dev.parent = dev->bus->parent; in ipack_device_init()
432 ret = dev_set_name(&dev->dev, in ipack_device_init()
433 "ipack-dev.%u.%u", dev->bus->bus_nr, dev->slot); in ipack_device_init()
437 device_initialize(&dev->dev); in ipack_device_init()
439 if (dev->bus->ops->set_clockrate(dev, 8)) in ipack_device_init()
440 dev_warn(&dev->dev, "failed to switch to 8 MHz operation for reading of device ID.\n"); in ipack_device_init()
441 if (dev->bus->ops->reset_timeout(dev)) in ipack_device_init()
442 dev_warn(&dev->dev, "failed to reset potential timeout."); in ipack_device_init()
446 dev_err(&dev->dev, "error reading device id section.\n"); in ipack_device_init()
450 /* if the device supports 32 MHz operation, use it. */ in ipack_device_init()
451 if (dev->speed_32mhz) { in ipack_device_init()
452 ret = dev->bus->ops->set_clockrate(dev, 32); in ipack_device_init()
454 dev_err(&dev->dev, "failed to switch to 32 MHz operation.\n"); in ipack_device_init()
463 return device_add(&dev->dev); in ipack_device_add()
469 device_del(&dev->dev); in ipack_device_del()
476 get_device(&dev->dev); in ipack_get_device()
482 put_device(&dev->dev); in ipack_put_device()
503 MODULE_DESCRIPTION("Industry-pack bus core");