modelm101.c 1.3 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546
  1. /* Copyright 2019 iw0rm3r
  2. *
  3. * This program is free software: you can redistribute it and/or modify
  4. * it under the terms of the GNU General Public License as published by
  5. * the Free Software Foundation, either version 2 of the License, or
  6. * (at your option) any later version.
  7. *
  8. * This program is distributed in the hope that it will be useful,
  9. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11. * GNU General Public License for more details.
  12. *
  13. * You should have received a copy of the GNU General Public License
  14. * along with this program. If not, see <http://www.gnu.org/licenses/>.
  15. */
  16. #include "modelm101.h"
  17. void keyboard_pre_init_kb(void) {
  18. /* Setting status LEDs pins to output and +5V (off) */
  19. setPinOutput(B4);
  20. setPinOutput(B5);
  21. setPinOutput(B6);
  22. writePinHigh(B4);
  23. writePinHigh(B5);
  24. writePinHigh(B6);
  25. }
  26. void led_set_kb(uint8_t usb_led) {
  27. if (usb_led & (1<<USB_LED_NUM_LOCK)) {
  28. writePinLow(B4);
  29. } else {
  30. writePinHigh(B4);
  31. }
  32. if (usb_led & (1<<USB_LED_CAPS_LOCK)) {
  33. writePinLow(B6);
  34. } else {
  35. writePinHigh(B6);
  36. }
  37. if (usb_led & (1<<USB_LED_SCROLL_LOCK)) {
  38. writePinLow(B5);
  39. } else {
  40. writePinHigh(B5);
  41. }
  42. led_set_user(usb_led);
  43. }