[Keyboard] Added aeboards/aegis (#5099)

[qmk_firmware.git] / keyboards / kinesis / stapelberg / stapelberg.c

diff --git a/keyboards/kinesis/stapelberg/stapelberg.c b/keyboards/kinesis/stapelberg/stapelberg.c
index e551dacc4e0bca9354da7432d46e399d170f912c..af407ac4fc645d547d231b193c6b852eed5c7e6a 100644 (file)
--- a/keyboards/kinesis/stapelberg/stapelberg.c
+++ b/keyboards/kinesis/stapelberg/stapelberg.c
@@ -3,6 +3,11 @@
 void matrix_init_kb(void) {
        // put your keyboard start-up code here
        // runs once when the firmware starts up
+    // * Set our LED pins as output
+    DDRF |= (1<<0); // Keypad LED
+    DDRF |= (1<<1); // ScrLock LED
+    DDRF |= (1<<2); // NumLock LED
+    DDRF |= (1<<3); // CapsLock LED
 
        matrix_init_user();
 }
@@ -21,20 +26,36 @@ bool process_record_kb(uint16_t keycode, keyrecord_t *record) {
        return process_record_user(keycode, record);
 }
 
-void led_set_kb(uint8_t usb_led) {
-       // put your keyboard LED indicator (ex: Caps Lock LED) toggling code here
-
-       led_set_user(usb_led);
-
-inline void kinesis_keypad_led_on(void)    { DDRF |=  (1<<0); PORTF |=  (1<<0); }
-inline void kinesis_scroll_led_on(void)    { DDRF |=  (1<<1); PORTF |=  (1<<1); }
-inline void kinesis_num_led_on(void)    { DDRF |=  (1<<2); PORTF |=  (1<<2); }
-inline void kinesis_caps_led_on(void)    { DDRF |=  (1<<3); PORTF |=  (1<<3); }
-
-inline void kinesis_keypad_led_off(void)   { DDRF &= ~(1<<0); PORTF &= ~(1<<0); }
-inline void kinesis_scroll_led_off(void)   { DDRF &= ~(1<<1); PORTF &= ~(1<<1); }
-inline void kinesis_num_led_off(void)   { DDRF &= ~(1<<2); PORTF &= ~(1<<2); }
-inline void kinesis_caps_led_off(void)   { DDRF &= ~(1<<3); PORTF &= ~(1<<3); }
-
+void led_init_ports() {
+  // * Set our LED pins as output
+  DDRF |= (1<<0); // Keypad LED
+  DDRF |= (1<<1); // ScrLock LED
+  DDRF |= (1<<2); // NumLock LED
+  DDRF |= (1<<3); // CapsLock LED
+}
 
+void led_set_kb(uint8_t usb_led) {
+  if (usb_led & (1<<USB_LED_COMPOSE)) {
+      PORTF &= ~(1<<0);
+  } else {
+      PORTF |= (1<<0);
+  }
+
+  if (usb_led & (1<<USB_LED_SCROLL_LOCK)) {
+      PORTF &= ~(1<<1);
+  } else {
+      PORTF |= (1<<1);
+  }
+
+  if (usb_led & (1<<USB_LED_NUM_LOCK)) {
+      PORTF &= ~(1<<2);
+  } else {
+      PORTF |= (1<<2);
+  }
+
+  if (usb_led & (1<<USB_LED_CAPS_LOCK)) {
+      PORTF &= ~(1<<3);
+  } else {
+      PORTF |= (1<<3);
+  }
 }