Properly fix i2c leds for ergodox shine (#356)

1 files changed, 22 insertions, 19 deletions

diff --git a/keyboards/ergodox_ez/led_i2c.c b/keyboards/ergodox_ez/led_i2c.c
index 5d3bdd1b5a..e9ab247ba1 100644
--- a/keyboards/ergodox_ez/led_i2c.c
+++ b/keyboards/ergodox_ez/led_i2c.c
@@ -21,35 +21,38 @@ along with this program.  If not, see <http://www.gnu.org/licenses/>.
 #ifdef RGBLIGHT_ENABLE
 
 #    include "ergodox_ez.h"
-i2c_status_t i2c_rgblight = 0x20;
+bool  i2c_rgblight = true;
 extern bool         i2c_initialized;
 
 void rgblight_call_driver(LED_TYPE *led, uint8_t led_num) {
-    if (i2c_initialized && !mcp23018_status) {
-        if (!i2c_rgblight)  i2c_rgblight = i2c_start(0x84, ERGODOX_EZ_I2C_TIMEOUT);
-
-        uint8_t i = 0;
+    if (i2c_initialized && !mcp23018_status && i2c_rgblight) {
+        if (i2c_start(0x84, ERGODOX_EZ_I2C_TIMEOUT)) {
+            i2c_rgblight = false;
+            i2c_stop();
+        } else {
+            uint8_t i = 0;
 #    if defined(ERGODOX_LED_30)
-        // prevent right-half code from trying to bitbang all 30
-        // so with 30 LEDs, we count from 29 to 15 here, and the
-        // other half does 0 to 14.
-        uint8_t half_led_num = RGBLED_NUM / 2;
-        for (i = half_led_num + half_led_num - 1; i >= half_led_num; --i)
+            // prevent right-half code from trying to bitbang all 30
+            // so with 30 LEDs, we count from 29 to 15 here, and the
+            // other half does 0 to 14.
+            uint8_t half_led_num = RGBLED_NUM / 2;
+            for (i = half_led_num + half_led_num - 1; i >= half_led_num; --i)
 #    elif defined(ERGODOX_LED_15_MIRROR)
-        for (i = 0; i < led_num; ++i)
+            for (i = 0; i < led_num; ++i)
 #    else // ERGDOX_LED_15 non-mirrored
-        for (i = led_num - 1; i >= 0; --i)
+            for (i = led_num - 1; i >= 0; --i)
 #    endif
-        {
-            uint8_t *data = (uint8_t *)(led + i);
-            if (!i2c_rgblight) i2c_rgblight = i2c_write(*data++, ERGODOX_EZ_I2C_TIMEOUT);
-            if (!i2c_rgblight) i2c_rgblight = i2c_write(*data++, ERGODOX_EZ_I2C_TIMEOUT);
-            if (!i2c_rgblight) i2c_rgblight = i2c_write(*data++, ERGODOX_EZ_I2C_TIMEOUT);
+            {
+                uint8_t *data = (uint8_t *)(led + i);
+                i2c_write(*data++, ERGODOX_EZ_I2C_TIMEOUT);
+                i2c_write(*data++, ERGODOX_EZ_I2C_TIMEOUT);
+                i2c_write(*data++, ERGODOX_EZ_I2C_TIMEOUT);
 #    ifdef RGBW
-            if (!i2c_rgblight) i2c_rgblight = i2c_write(*data++, ERGODOX_EZ_I2C_TIMEOUT);
+                i2c_write(*data++, ERGODOX_EZ_I2C_TIMEOUT);
 #    endif
+            }
+            i2c_stop();
         }
-        i2c_stop();
     }
 
     ws2812_setleds(led, led_num);