X-Git-Url: https://git.friedersdorff.com/?a=blobdiff_plain;ds=sidebyside;f=keyboard%2Fergodox%2Fergodox.c;h=494d13c182ab4f3349aa94fe07ab05e6a8c13572;hb=d2427380e3d82df0f9b543615c27f9d823a09306;hp=8aed78ecb72688df7ab2d9345292f25358d46d93;hpb=cfc23836e5f9571056d3710b8580c1f27b91ed54;p=max%2Ftmk_keyboard.git

diff --git a/keyboard/ergodox/ergodox.c b/keyboard/ergodox/ergodox.c
index 8aed78ec..494d13c1 100644
--- a/keyboard/ergodox/ergodox.c
+++ b/keyboard/ergodox/ergodox.c
@@ -38,6 +38,7 @@ Most used files are located at
 #include "i2cmaster.h"
 
 bool i2c_initialized = 0;
+uint8_t mcp23018_status = 0x20;
 
 bool ergodox_left_led_1 = 0;  // left top
 bool ergodox_left_led_2 = 0;  // left middle
@@ -62,8 +63,10 @@ void init_ergodox(void)
     PORTC |=  (1<<7);
     PORTD |=  (1<<7 | 1<<5 | 1<<4);
     PORTE |=  (1<<6);
+}
 
-    // blink leds
+void ergodox_blink_all_leds(void)
+{
     ergodox_led_all_off();
     ergodox_led_all_set(LED_BRIGHTNESS_HI);
     ergodox_led_all_on();
@@ -72,7 +75,7 @@ void init_ergodox(void)
 }
 
 uint8_t init_mcp23018(void) {
-    uint8_t err = 0x20;
+    mcp23018_status = 0x20;
 
     // I2C subsystem
     if (i2c_initialized == 0) {
@@ -85,37 +88,50 @@ uint8_t init_mcp23018(void) {
     // - unused  : input  : 1
     // - input   : input  : 1
     // - driving : output : 0
-    err = i2c_start(I2C_ADDR_WRITE);    if (err) goto out;
-    err = i2c_write(IODIRA);            if (err) goto out;
-    err = i2c_write(0b00000000);        if (err) goto out;
-    err = i2c_write(0b00111111);        if (err) goto out;
+    mcp23018_status = i2c_start(I2C_ADDR_WRITE);    if (mcp23018_status) goto out;
+    mcp23018_status = i2c_write(IODIRA);            if (mcp23018_status) goto out;
+    mcp23018_status = i2c_write(0b00000000);        if (mcp23018_status) goto out;
+    mcp23018_status = i2c_write(0b00111111);        if (mcp23018_status) goto out;
     i2c_stop();
+
     // set pull-up
     // - unused  : on  : 1
     // - input   : on  : 1
     // - driving : off : 0
-    err = i2c_start(I2C_ADDR_WRITE);    if (err) goto out;
-    err = i2c_write(GPPUA);             if (err) goto out;
-    err = i2c_write(0b00000000);        if (err) goto out;
-    err = i2c_write(0b00111111);        if (err) goto out;
+    mcp23018_status = i2c_start(I2C_ADDR_WRITE);    if (mcp23018_status) goto out;
+    mcp23018_status = i2c_write(GPPUA);             if (mcp23018_status) goto out;
+    mcp23018_status = i2c_write(0b00000000);        if (mcp23018_status) goto out;
+    mcp23018_status = i2c_write(0b00111111);        if (mcp23018_status) goto out;
+
+out:
     i2c_stop();
 
+    if (!mcp23018_status) mcp23018_status = ergodox_left_leds_update();
+
+    return mcp23018_status;
+}
+
+uint8_t ergodox_left_leds_update(void) {
+    if (mcp23018_status) { // if there was an error
+        return mcp23018_status;
+    }
+
     // set logical value (doesn't matter on inputs)
     // - unused  : hi-Z : 1
     // - input   : hi-Z : 1
     // - driving : hi-Z : 1
-    err = i2c_start(I2C_ADDR_WRITE);    if (err) goto out;
-    err = i2c_write(OLATA);             if (err) goto out;
-    err = i2c_write(0b11111111
+    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 (err) goto out;
-    err = i2c_write(0b11111111
+          );                                        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 (err) goto out;
+          );                                        if (mcp23018_status) goto out;
 
 out:
     i2c_stop();
-    return err;
+    return mcp23018_status;
 }