leds-locomo.c 2.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596
  1. /*
  2. * linux/drivers/leds/leds-locomo.c
  3. *
  4. * Copyright (C) 2005 John Lenz <lenz@cs.wisc.edu>
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License version 2 as
  8. * published by the Free Software Foundation.
  9. */
  10. #include <linux/kernel.h>
  11. #include <linux/init.h>
  12. #include <linux/device.h>
  13. #include <linux/leds.h>
  14. #include <asm/hardware.h>
  15. #include <asm/hardware/locomo.h>
  16. static void locomoled_brightness_set(struct led_classdev *led_cdev,
  17. enum led_brightness value, int offset)
  18. {
  19. struct locomo_dev *locomo_dev = LOCOMO_DEV(led_cdev->class_dev->dev);
  20. unsigned long flags;
  21. local_irq_save(flags);
  22. if (value)
  23. locomo_writel(LOCOMO_LPT_TOFH, locomo_dev->mapbase + offset);
  24. else
  25. locomo_writel(LOCOMO_LPT_TOFL, locomo_dev->mapbase + offset);
  26. local_irq_restore(flags);
  27. }
  28. static void locomoled_brightness_set0(struct led_classdev *led_cdev,
  29. enum led_brightness value)
  30. {
  31. locomoled_brightness_set(led_cdev, value, LOCOMO_LPT0);
  32. }
  33. static void locomoled_brightness_set1(struct led_classdev *led_cdev,
  34. enum led_brightness value)
  35. {
  36. locomoled_brightness_set(led_cdev, value, LOCOMO_LPT1);
  37. }
  38. static struct led_classdev locomo_led0 = {
  39. .name = "locomo:amber",
  40. .default_trigger = "sharpsl-charge",
  41. .brightness_set = locomoled_brightness_set0,
  42. };
  43. static struct led_classdev locomo_led1 = {
  44. .name = "locomo:green",
  45. .default_trigger = "nand-disk",
  46. .brightness_set = locomoled_brightness_set1,
  47. };
  48. static int locomoled_probe(struct locomo_dev *ldev)
  49. {
  50. int ret;
  51. ret = led_classdev_register(&ldev->dev, &locomo_led0);
  52. if (ret < 0)
  53. return ret;
  54. ret = led_classdev_register(&ldev->dev, &locomo_led1);
  55. if (ret < 0)
  56. led_classdev_unregister(&locomo_led0);
  57. return ret;
  58. }
  59. static int locomoled_remove(struct locomo_dev *dev)
  60. {
  61. led_classdev_unregister(&locomo_led0);
  62. led_classdev_unregister(&locomo_led1);
  63. return 0;
  64. }
  65. static struct locomo_driver locomoled_driver = {
  66. .drv = {
  67. .name = "locomoled"
  68. },
  69. .devid = LOCOMO_DEVID_LED,
  70. .probe = locomoled_probe,
  71. .remove = locomoled_remove,
  72. };
  73. static int __init locomoled_init(void)
  74. {
  75. return locomo_driver_register(&locomoled_driver);
  76. }
  77. module_init(locomoled_init);
  78. MODULE_AUTHOR("John Lenz <lenz@cs.wisc.edu>");
  79. MODULE_DESCRIPTION("Locomo LED driver");
  80. MODULE_LICENSE("GPL");