umc-dev.c 2.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104
  1. /*
  2. * UWB Multi-interface Controller device management.
  3. *
  4. * Copyright (C) 2007 Cambridge Silicon Radio Ltd.
  5. *
  6. * This file is released under the GNU GPL v2.
  7. */
  8. #include <linux/kernel.h>
  9. #include <linux/uwb/umc.h>
  10. #define D_LOCAL 0
  11. #include <linux/uwb/debug.h>
  12. static void umc_device_release(struct device *dev)
  13. {
  14. struct umc_dev *umc = to_umc_dev(dev);
  15. kfree(umc);
  16. }
  17. /**
  18. * umc_device_create - allocate a child UMC device
  19. * @parent: parent of the new UMC device.
  20. * @n: index of the new device.
  21. *
  22. * The new UMC device will have a bus ID of the parent with '-n'
  23. * appended.
  24. */
  25. struct umc_dev *umc_device_create(struct device *parent, int n)
  26. {
  27. struct umc_dev *umc;
  28. umc = kzalloc(sizeof(struct umc_dev), GFP_KERNEL);
  29. if (umc) {
  30. snprintf(umc->dev.bus_id, sizeof(umc->dev.bus_id), "%s-%d",
  31. parent->bus_id, n);
  32. umc->dev.parent = parent;
  33. umc->dev.bus = &umc_bus_type;
  34. umc->dev.release = umc_device_release;
  35. umc->dev.dma_mask = parent->dma_mask;
  36. }
  37. return umc;
  38. }
  39. EXPORT_SYMBOL_GPL(umc_device_create);
  40. /**
  41. * umc_device_register - register a UMC device
  42. * @umc: pointer to the UMC device
  43. *
  44. * The memory resource for the UMC device is acquired and the device
  45. * registered with the system.
  46. */
  47. int umc_device_register(struct umc_dev *umc)
  48. {
  49. int err;
  50. d_fnstart(3, &umc->dev, "(umc_dev %p)\n", umc);
  51. err = request_resource(umc->resource.parent, &umc->resource);
  52. if (err < 0) {
  53. dev_err(&umc->dev, "can't allocate resource range "
  54. "%016Lx to %016Lx: %d\n",
  55. (unsigned long long)umc->resource.start,
  56. (unsigned long long)umc->resource.end,
  57. err);
  58. goto error_request_resource;
  59. }
  60. err = device_register(&umc->dev);
  61. if (err < 0)
  62. goto error_device_register;
  63. d_fnend(3, &umc->dev, "(umc_dev %p) = 0\n", umc);
  64. return 0;
  65. error_device_register:
  66. release_resource(&umc->resource);
  67. error_request_resource:
  68. d_fnend(3, &umc->dev, "(umc_dev %p) = %d\n", umc, err);
  69. return err;
  70. }
  71. EXPORT_SYMBOL_GPL(umc_device_register);
  72. /**
  73. * umc_device_unregister - unregister a UMC device
  74. * @umc: pointer to the UMC device
  75. *
  76. * First we unregister the device, make sure the driver can do it's
  77. * resource release thing and then we try to release any left over
  78. * resources. We take a ref to the device, to make sure it doesn't
  79. * dissapear under our feet.
  80. */
  81. void umc_device_unregister(struct umc_dev *umc)
  82. {
  83. struct device *dev;
  84. if (!umc)
  85. return;
  86. dev = get_device(&umc->dev);
  87. d_fnstart(3, dev, "(umc_dev %p)\n", umc);
  88. device_unregister(&umc->dev);
  89. release_resource(&umc->resource);
  90. d_fnend(3, dev, "(umc_dev %p) = void\n", umc);
  91. put_device(dev);
  92. }
  93. EXPORT_SYMBOL_GPL(umc_device_unregister);