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 if (!drv->ops->probe) in ipack_bus_probe()
68 return -EINVAL; in ipack_bus_probe()
70 return drv->ops->probe(dev); in ipack_bus_probe()
73 static int ipack_bus_remove(struct device *device) in ipack_bus_remove() argument
75 struct ipack_device *dev = to_ipack_dev(device); in ipack_bus_remove()
76 struct ipack_driver *drv = to_ipack_driver(device->driver); in ipack_bus_remove()
78 if (!drv->ops->remove) in ipack_bus_remove()
79 return -EINVAL; in ipack_bus_remove()
81 drv->ops->remove(dev); in ipack_bus_remove()
85 static int ipack_uevent(struct device *dev, struct kobj_uevent_env *env) in ipack_uevent()
90 return -ENODEV; in ipack_uevent()
95 "MODALIAS=ipack:f%02Xv%08Xd%08X", idev->id_format, in ipack_uevent()
96 idev->id_vendor, idev->id_device)) in ipack_uevent()
97 return -ENOMEM; in ipack_uevent()
104 field##_show(struct device *dev, struct device_attribute *attr, \
108 return sprintf(buf, format_string, idev->field); \
111 static ssize_t id_show(struct device *dev, in id_show()
118 switch (idev->id_format) { in id_show()
124 return -EIO; in id_show()
127 for (i = 0; i < idev->id_avail; i++) { in id_show()
134 sprintf(&buf[c], "%02x", idev->id[i]); in id_show()
142 id_vendor_show(struct device *dev, struct device_attribute *attr, char *buf) in id_vendor_show()
145 switch (idev->id_format) { in id_vendor_show()
147 return sprintf(buf, "0x%02x\n", idev->id_vendor); in id_vendor_show()
149 return sprintf(buf, "0x%06x\n", idev->id_vendor); in id_vendor_show()
151 return -EIO; in id_vendor_show()
156 id_device_show(struct device *dev, struct device_attribute *attr, char *buf) in id_device_show()
159 switch (idev->id_format) { in id_device_show()
161 return sprintf(buf, "0x%02x\n", idev->id_device); in id_device_show()
163 return sprintf(buf, "0x%04x\n", idev->id_device); in id_device_show()
165 return -EIO; in id_device_show()
169 static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, in modalias_show()
174 return sprintf(buf, "ipac:f%02Xv%08Xd%08X", idev->id_format, in modalias_show()
175 idev->id_vendor, idev->id_device); in modalias_show()
180 static DEVICE_ATTR_RO(id);
205 struct ipack_bus_device *ipack_bus_register(struct device *parent, int slots, in ipack_bus_register()
222 bus->bus_nr = bus_nr; in ipack_bus_register()
223 bus->parent = parent; in ipack_bus_register()
224 bus->slots = slots; in ipack_bus_register()
225 bus->ops = ops; in ipack_bus_register()
226 bus->owner = owner; in ipack_bus_register()
231 static int ipack_unregister_bus_member(struct device *dev, void *data) in ipack_unregister_bus_member()
236 if (idev->bus == bus) in ipack_unregister_bus_member()
246 ida_simple_remove(&ipack_ida, bus->bus_nr); in ipack_bus_unregister()
255 edrv->driver.owner = owner; in ipack_driver_register()
256 edrv->driver.name = name; in ipack_driver_register()
257 edrv->driver.bus = &ipack_bus_type; in ipack_driver_register()
258 return driver_register(&edrv->driver); in ipack_driver_register()
264 driver_unregister(&edrv->driver); in ipack_driver_unregister()
279 * The algorithm in lib/crc-ccitt.c does not seem to apply since it uses the
289 for (i = 0; i < dev->id_avail; i++) { in ipack_calc_crc1()
290 c = (i != 11) ? dev->id[i] : 0; in ipack_calc_crc1()
304 for (i = 0; i < dev->id_avail; i++) { in ipack_calc_crc2()
305 c = ((i != 0x18) && (i != 0x19)) ? dev->id[i] : 0; in ipack_calc_crc2()
314 u8 *id = dev->id; in ipack_parse_id1() local
317 dev->id_vendor = id[4]; in ipack_parse_id1()
318 dev->id_device = id[5]; in ipack_parse_id1()
319 dev->speed_8mhz = 1; in ipack_parse_id1()
320 dev->speed_32mhz = (id[7] == 'H'); in ipack_parse_id1()
322 dev->id_crc_correct = (crc == id[11]); in ipack_parse_id1()
323 if (!dev->id_crc_correct) { in ipack_parse_id1()
324 dev_warn(&dev->dev, "ID CRC invalid found 0x%x, expected 0x%x.\n", in ipack_parse_id1()
325 id[11], crc); in ipack_parse_id1()
331 __be16 *id = (__be16 *) dev->id; in ipack_parse_id2() local
334 dev->id_vendor = ((be16_to_cpu(id[3]) & 0xff) << 16) in ipack_parse_id2()
335 + be16_to_cpu(id[4]); in ipack_parse_id2()
336 dev->id_device = be16_to_cpu(id[5]); in ipack_parse_id2()
337 flags = be16_to_cpu(id[10]); in ipack_parse_id2()
338 dev->speed_8mhz = !!(flags & 2); in ipack_parse_id2()
339 dev->speed_32mhz = !!(flags & 4); in ipack_parse_id2()
341 dev->id_crc_correct = (crc == be16_to_cpu(id[12])); in ipack_parse_id2()
342 if (!dev->id_crc_correct) { in ipack_parse_id2()
343 dev_warn(&dev->dev, "ID CRC invalid found 0x%x, expected 0x%x.\n", in ipack_parse_id2()
344 id[11], crc); in ipack_parse_id2()
354 idmem = ioremap(dev->region[IPACK_ID_SPACE].start, in ipack_device_read_id()
355 dev->region[IPACK_ID_SPACE].size); in ipack_device_read_id()
357 dev_err(&dev->dev, "error mapping memory\n"); in ipack_device_read_id()
358 return -ENOMEM; in ipack_device_read_id()
361 /* Determine ID PROM Data Format. If we find the ids "IPAC" or "IPAH" in ipack_device_read_id()
362 * we are dealing with a IndustryPack format 1 device. If we detect in ipack_device_read_id()
364 * IndustryPack format 2 device */ in ipack_device_read_id()
370 dev->id_format = IPACK_ID_VERSION_1; in ipack_device_read_id()
371 dev->id_avail = ioread8(idmem + 0x15); in ipack_device_read_id()
372 if ((dev->id_avail < 0x0c) || (dev->id_avail > 0x40)) { in ipack_device_read_id()
373 dev_warn(&dev->dev, "invalid id size"); in ipack_device_read_id()
374 dev->id_avail = 0x0c; in ipack_device_read_id()
382 dev->id_format = IPACK_ID_VERSION_2; in ipack_device_read_id()
383 dev->id_avail = ioread16be(idmem + 0x16); in ipack_device_read_id()
384 if ((dev->id_avail < 0x1a) || (dev->id_avail > 0x40)) { in ipack_device_read_id()
385 dev_warn(&dev->dev, "invalid id size"); in ipack_device_read_id()
386 dev->id_avail = 0x1a; in ipack_device_read_id()
389 dev->id_format = IPACK_ID_VERSION_INVALID; in ipack_device_read_id()
390 dev->id_avail = 0; in ipack_device_read_id()
393 if (!dev->id_avail) { in ipack_device_read_id()
394 ret = -ENODEV; in ipack_device_read_id()
399 * ID ROM contents */ in ipack_device_read_id()
400 dev->id = kmalloc(dev->id_avail, GFP_KERNEL); in ipack_device_read_id()
401 if (!dev->id) { in ipack_device_read_id()
402 ret = -ENOMEM; in ipack_device_read_id()
405 for (i = 0; i < dev->id_avail; i++) { in ipack_device_read_id()
406 if (dev->id_format == IPACK_ID_VERSION_1) in ipack_device_read_id()
407 dev->id[i] = ioread8(idmem + (i << 1) + 1); in ipack_device_read_id()
409 dev->id[i] = ioread8(idmem + i); in ipack_device_read_id()
413 switch (dev->id_format) { in ipack_device_read_id()
432 dev->dev.bus = &ipack_bus_type; in ipack_device_init()
433 dev->dev.release = ipack_device_release; in ipack_device_init()
434 dev->dev.parent = dev->bus->parent; in ipack_device_init()
435 dev_set_name(&dev->dev, in ipack_device_init()
436 "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");