From 0ec46f769942a967d74a9a9b59b6829bf74b9a55 Mon Sep 17 00:00:00 2001
From: Bertrand Lemasle <blemasle@gmail.com>
Date: Mon, 6 Aug 2018 19:37:28 +1200
Subject: [PATCH] Straighten poweredCount logic for i2c

---
 Hardware.cpp | 9 +++++----
 1 file changed, 5 insertions(+), 4 deletions(-)

diff --git a/Hardware.cpp b/Hardware.cpp
index f612ce4..f58fd13 100644
--- a/Hardware.cpp
+++ b/Hardware.cpp
@@ -120,9 +120,9 @@ namespace hardware {
 				pinMode(I2C_PWR, OUTPUT);
 
 				Wire.begin();
+				poweredCount = 1;
 			}
-
-			poweredCount++;
+			else poweredCount++;
 		}
 
 		void powerOff(bool forced = false) {
@@ -137,9 +137,10 @@ namespace hardware {
 				//disable i2c internal pull ups
 				digitalWrite(A4, LOW);
 				digitalWrite(A5, LOW);
-			}
 
-			poweredCount--;
+				poweredCount = 0;
+			}
+			else if(poweredCount > 1) poweredCount--; //avoid decrement if == 0
 		}
 	}
 }