1 files changed, 54 insertions, 0 deletions

diff --git a/keyboards/ktec/ergodone/ergodone.c b/keyboards/ktec/ergodone/ergodone.c
new file mode 100644
index 000000000..e0579408e
--- /dev/null
+++ b/keyboards/ktec/ergodone/ergodone.c
@@ -0,0 +1,54 @@
+#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);
+
+extern inline void ergodox_led_all_off(void);
+
+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();
+}