summaryrefslogtreecommitdiffstats
path: root/keyboards/ergodox_ez/ergodox_ez.c
diff options
context:
space:
mode:
Diffstat (limited to 'keyboards/ergodox_ez/ergodox_ez.c')
-rw-r--r--keyboards/ergodox_ez/ergodox_ez.c73
1 files changed, 73 insertions, 0 deletions
diff --git a/keyboards/ergodox_ez/ergodox_ez.c b/keyboards/ergodox_ez/ergodox_ez.c
index 3609f6f810..8ada551aea 100644
--- a/keyboards/ergodox_ez/ergodox_ez.c
+++ b/keyboards/ergodox_ez/ergodox_ez.c
@@ -61,11 +61,46 @@ void ergodox_blink_all_leds(void)
_delay_ms(50);
ergodox_right_led_3_on();
_delay_ms(50);
+#ifdef LEFT_LEDS
+ ergodox_left_led_1_on();
+ _delay_ms(50);
+ if (!mcp23018_status) {
+ mcp23018_status = ergodox_left_leds_update();
+ }
+ ergodox_left_led_2_on();
+ _delay_ms(50);
+ if (!mcp23018_status) {
+ mcp23018_status = ergodox_left_leds_update();
+ }
+ ergodox_left_led_3_on();
+ _delay_ms(50);
+ if (!mcp23018_status) {
+ mcp23018_status = ergodox_left_leds_update();
+ }
+#endif
ergodox_right_led_1_off();
_delay_ms(50);
ergodox_right_led_2_off();
_delay_ms(50);
ergodox_right_led_3_off();
+#ifdef LEFT_LEDS
+ _delay_ms(50);
+ ergodox_left_led_1_off();
+ if (!mcp23018_status) {
+ mcp23018_status = ergodox_left_leds_update();
+ }
+ _delay_ms(50);
+ ergodox_left_led_2_off();
+ if (!mcp23018_status) {
+ mcp23018_status = ergodox_left_leds_update();
+ }
+ _delay_ms(50);
+ ergodox_left_led_3_off();
+ if (!mcp23018_status) {
+ mcp23018_status = ergodox_left_leds_update();
+ }
+#endif
+
//ergodox_led_all_on();
//_delay_ms(333);
ergodox_led_all_off();
@@ -107,11 +142,49 @@ uint8_t init_mcp23018(void) {
out:
i2c_stop();
+#ifdef LEFT_LEDS
+ if (!mcp23018_status) mcp23018_status = ergodox_left_leds_update();
+#endif // LEFT_LEDS
+
// SREG=sreg_prev;
return mcp23018_status;
}
+#ifdef LEFT_LEDS
+uint8_t ergodox_left_leds_update(void) {
+ if (mcp23018_status) { // if there was an error
+ return mcp23018_status;
+ }
+#define LEFT_LED_1_SHIFT 7 // in MCP23018 port B
+#define LEFT_LED_2_SHIFT 6 // in MCP23018 port B
+#define LEFT_LED_3_SHIFT 7 // in MCP23018 port A
+
+ // set logical value (doesn't matter on inputs)
+ // - unused : hi-Z : 1
+ // - input : hi-Z : 1
+ // - driving : hi-Z : 1
+ mcp23018_status = i2c_start(I2C_ADDR_WRITE);
+ if (mcp23018_status) goto out;
+ mcp23018_status = i2c_write(OLATA);
+ if (mcp23018_status) goto out;
+ mcp23018_status = i2c_write(0b11111111
+ & ~(ergodox_left_led_3<<LEFT_LED_3_SHIFT)
+ );
+ if (mcp23018_status) goto out;
+ mcp23018_status = i2c_write(0b11111111
+ & ~(ergodox_left_led_2<<LEFT_LED_2_SHIFT)
+ & ~(ergodox_left_led_1<<LEFT_LED_1_SHIFT)
+ );
+ if (mcp23018_status) goto out;
+
+ out:
+ i2c_stop();
+ return mcp23018_status;
+}
+#endif
+
+
#ifdef ONEHAND_ENABLE
__attribute__ ((weak))
// swap-hands action needs a matrix to define the swap