leds.c 1.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445
  1. /*
  2. * (C) Copyright 2011
  3. * CompuLab, Ltd. <www.compulab.co.il>
  4. *
  5. * Author: Igor Grinberg <grinberg@compulab.co.il>
  6. *
  7. * This program is free software; you can redistribute it and/or
  8. * modify it under the terms of the GNU General Public License as
  9. * published by the Free Software Foundation; either version 2 of
  10. * the License, or (at your option) any later version.
  11. *
  12. * This program is distributed in the hope that it will be useful,
  13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  15. * GNU General Public License for more details.
  16. *
  17. * You should have received a copy of the GNU General Public License
  18. * along with this program; if not, write to the Free Software
  19. * Foundation, Inc.
  20. */
  21. #include <common.h>
  22. #include <status_led.h>
  23. #include <asm/gpio.h>
  24. static unsigned int leds[] = { GREEN_LED_GPIO };
  25. void __led_init(led_id_t mask, int state)
  26. {
  27. if (gpio_request(leds[mask], "") != 0) {
  28. printf("%s: failed requesting GPIO%u\n", __func__, leds[mask]);
  29. return;
  30. }
  31. gpio_direction_output(leds[mask], 0);
  32. }
  33. void __led_set(led_id_t mask, int state)
  34. {
  35. gpio_set_value(leds[mask], state == STATUS_LED_ON);
  36. }
  37. void __led_toggle(led_id_t mask)
  38. {
  39. gpio_set_value(leds[mask], !gpio_get_value(leds[mask]));
  40. }