leds-fsg.c 4.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * LED Driver for the Freecom FSG-3
  4. *
  5. * Copyright (c) 2008 Rod Whitby <rod@whitby.id.au>
  6. *
  7. * Author: Rod Whitby <rod@whitby.id.au>
  8. *
  9. * Based on leds-spitz.c
  10. * Copyright 2005-2006 Openedhand Ltd.
  11. * Author: Richard Purdie <rpurdie@openedhand.com>
  12. */
  13. #include <linux/kernel.h>
  14. #include <linux/platform_device.h>
  15. #include <linux/leds.h>
  16. #include <linux/module.h>
  17. #include <linux/io.h>
  18. #include <mach/hardware.h>
  19. #define FSG_LED_WLAN_BIT 0
  20. #define FSG_LED_WAN_BIT 1
  21. #define FSG_LED_SATA_BIT 2
  22. #define FSG_LED_USB_BIT 4
  23. #define FSG_LED_RING_BIT 5
  24. #define FSG_LED_SYNC_BIT 7
  25. static short __iomem *latch_address;
  26. static unsigned short latch_value;
  27. static void fsg_led_wlan_set(struct led_classdev *led_cdev,
  28. enum led_brightness value)
  29. {
  30. if (value) {
  31. latch_value &= ~(1 << FSG_LED_WLAN_BIT);
  32. *latch_address = latch_value;
  33. } else {
  34. latch_value |= (1 << FSG_LED_WLAN_BIT);
  35. *latch_address = latch_value;
  36. }
  37. }
  38. static void fsg_led_wan_set(struct led_classdev *led_cdev,
  39. enum led_brightness value)
  40. {
  41. if (value) {
  42. latch_value &= ~(1 << FSG_LED_WAN_BIT);
  43. *latch_address = latch_value;
  44. } else {
  45. latch_value |= (1 << FSG_LED_WAN_BIT);
  46. *latch_address = latch_value;
  47. }
  48. }
  49. static void fsg_led_sata_set(struct led_classdev *led_cdev,
  50. enum led_brightness value)
  51. {
  52. if (value) {
  53. latch_value &= ~(1 << FSG_LED_SATA_BIT);
  54. *latch_address = latch_value;
  55. } else {
  56. latch_value |= (1 << FSG_LED_SATA_BIT);
  57. *latch_address = latch_value;
  58. }
  59. }
  60. static void fsg_led_usb_set(struct led_classdev *led_cdev,
  61. enum led_brightness value)
  62. {
  63. if (value) {
  64. latch_value &= ~(1 << FSG_LED_USB_BIT);
  65. *latch_address = latch_value;
  66. } else {
  67. latch_value |= (1 << FSG_LED_USB_BIT);
  68. *latch_address = latch_value;
  69. }
  70. }
  71. static void fsg_led_sync_set(struct led_classdev *led_cdev,
  72. enum led_brightness value)
  73. {
  74. if (value) {
  75. latch_value &= ~(1 << FSG_LED_SYNC_BIT);
  76. *latch_address = latch_value;
  77. } else {
  78. latch_value |= (1 << FSG_LED_SYNC_BIT);
  79. *latch_address = latch_value;
  80. }
  81. }
  82. static void fsg_led_ring_set(struct led_classdev *led_cdev,
  83. enum led_brightness value)
  84. {
  85. if (value) {
  86. latch_value &= ~(1 << FSG_LED_RING_BIT);
  87. *latch_address = latch_value;
  88. } else {
  89. latch_value |= (1 << FSG_LED_RING_BIT);
  90. *latch_address = latch_value;
  91. }
  92. }
  93. static struct led_classdev fsg_wlan_led = {
  94. .name = "fsg:blue:wlan",
  95. .brightness_set = fsg_led_wlan_set,
  96. .flags = LED_CORE_SUSPENDRESUME,
  97. };
  98. static struct led_classdev fsg_wan_led = {
  99. .name = "fsg:blue:wan",
  100. .brightness_set = fsg_led_wan_set,
  101. .flags = LED_CORE_SUSPENDRESUME,
  102. };
  103. static struct led_classdev fsg_sata_led = {
  104. .name = "fsg:blue:sata",
  105. .brightness_set = fsg_led_sata_set,
  106. .flags = LED_CORE_SUSPENDRESUME,
  107. };
  108. static struct led_classdev fsg_usb_led = {
  109. .name = "fsg:blue:usb",
  110. .brightness_set = fsg_led_usb_set,
  111. .flags = LED_CORE_SUSPENDRESUME,
  112. };
  113. static struct led_classdev fsg_sync_led = {
  114. .name = "fsg:blue:sync",
  115. .brightness_set = fsg_led_sync_set,
  116. .flags = LED_CORE_SUSPENDRESUME,
  117. };
  118. static struct led_classdev fsg_ring_led = {
  119. .name = "fsg:blue:ring",
  120. .brightness_set = fsg_led_ring_set,
  121. .flags = LED_CORE_SUSPENDRESUME,
  122. };
  123. static int fsg_led_probe(struct platform_device *pdev)
  124. {
  125. int ret;
  126. /* Map the LED chip select address space */
  127. latch_address = (unsigned short *) devm_ioremap(&pdev->dev,
  128. IXP4XX_EXP_BUS_BASE(2), 512);
  129. if (!latch_address)
  130. return -ENOMEM;
  131. latch_value = 0xffff;
  132. *latch_address = latch_value;
  133. ret = devm_led_classdev_register(&pdev->dev, &fsg_wlan_led);
  134. if (ret < 0)
  135. return ret;
  136. ret = devm_led_classdev_register(&pdev->dev, &fsg_wan_led);
  137. if (ret < 0)
  138. return ret;
  139. ret = devm_led_classdev_register(&pdev->dev, &fsg_sata_led);
  140. if (ret < 0)
  141. return ret;
  142. ret = devm_led_classdev_register(&pdev->dev, &fsg_usb_led);
  143. if (ret < 0)
  144. return ret;
  145. ret = devm_led_classdev_register(&pdev->dev, &fsg_sync_led);
  146. if (ret < 0)
  147. return ret;
  148. ret = devm_led_classdev_register(&pdev->dev, &fsg_ring_led);
  149. if (ret < 0)
  150. return ret;
  151. return ret;
  152. }
  153. static struct platform_driver fsg_led_driver = {
  154. .probe = fsg_led_probe,
  155. .driver = {
  156. .name = "fsg-led",
  157. },
  158. };
  159. module_platform_driver(fsg_led_driver);
  160. MODULE_AUTHOR("Rod Whitby <rod@whitby.id.au>");
  161. MODULE_DESCRIPTION("Freecom FSG-3 LED driver");
  162. MODULE_LICENSE("GPL");