Ergodox EZ and Atreus 42 key dvorak layout updates (#1964)

[qmk_firmware.git] / keyboards / ergodone / ergodone.c

diff --git a/keyboards/ergodone/ergodone.c b/keyboards/ergodone/ergodone.c
index 6b8d8a0632b58a0cdc6fab9968609aae26993c09..dd05a8def1a9d74c1ff2c2b43dca7646b0321187 100644 (file)
--- a/keyboards/ergodone/ergodone.c
+++ b/keyboards/ergodone/ergodone.c
@@ -1,5 +1,52 @@
 #include "ergodone.h"
 
+extern inline void ergodox_board_led_on(void);
+extern inline void ergodox_right_led_1_on(void);
+extern inline void ergodox_right_led_2_on(void);
+extern inline void ergodox_right_led_3_on(void);
+extern inline void ergodox_right_led_on(uint8_t led);
+
+extern inline void ergodox_board_led_off(void);
+extern inline void ergodox_right_led_1_off(void);
+extern inline void ergodox_right_led_2_off(void);
+extern inline void ergodox_right_led_3_off(void);
+extern inline void ergodox_right_led_off(uint8_t led);
+
+void ergodox_led_init(void);
+void ergodox_blink_all_leds(void);
+
 void matrix_init_kb(void) {
+  ergodox_led_init();
+  ergodox_blink_all_leds();
   matrix_init_user();
 }
+
+void ergodox_led_init(void)
+ {
+     DDRB  |=  (1<<PB5 | 1<<PB6 | 1<<PB3);
+     PORTB &= ~(1<<PB5 | 1<<PB6 | 1<<PB3);
+     DDRB  |=  (1<<PB0);
+     PORTB |=  (1<<PB0);
+     DDRD  |=  (1<<PB5);
+     PORTD |=  (1<<PB5);
+}
+
+void ergodox_blink_all_leds(void)
+{
+    ergodox_led_all_off();
+    ergodox_led_all_set(LED_BRIGHTNESS_HI);
+    ergodox_right_led_1_on();
+    _delay_ms(50);
+    ergodox_right_led_2_on();
+    _delay_ms(50);
+    ergodox_right_led_3_on();
+    _delay_ms(50);
+    ergodox_right_led_1_off();
+    _delay_ms(50);
+    ergodox_right_led_2_off();
+    _delay_ms(50);
+    ergodox_right_led_3_off();
+    //ergodox_led_all_on();
+    //_delay_ms(333);
+    ergodox_led_all_off();
+}