Update System.cpp

Author: ifadiga

src/include/System.cpp

@@ -98,18 +98,46 @@ uint8_t System::readTouchpad(uint8_t _pad)
  */
 double System::readBattery()
 {
+	pinModeInternal(MCP23017_INT_ADDR, mcpRegsInt, 9, INPUT);
+	int state = digitalReadInternal(MCP23017_INT_ADDR, mcpRegsInt, 9);
+	pinModeInternal(MCP23017_INT_ADDR, mcpRegsInt, 9, OUTPUT);
+	
+	if (state)
+	{
+		digitalWriteInternal(MCP23017_INT_ADDR, mcpRegsInt, 9, LOW);
+	}
+	else
+	{
+		digitalWriteInternal(MCP23017_INT_ADDR, mcpRegsInt, 9, HIGH);
+	}
+	/*
 #ifdef ARDUINO_ESP32_DEV
     digitalWriteInternal(MCP23017_INT_ADDR, mcpRegsInt, 9, LOW);
 #else
     digitalWriteInternal(MCP23017_INT_ADDR, mcpRegsInt, 9, HIGH);
 #endif
+*/
     delay(1);
     int adc = analogRead(35);
+	if (state)
+	{
+		pinModeInternal(MCP23017_INT_ADDR, mcpRegsInt, 9, INPUT);
+	}
+	else
+	{		
+		digitalWriteInternal(MCP23017_INT_ADDR, mcpRegsInt, 9, LOW);
+	}
+	
+	
+	
+	/*
+	
 #ifdef ARDUINO_ESP32_DEV
     digitalWriteInternal(MCP23017_INT_ADDR, mcpRegsInt, 9, HIGH);
 #else
     digitalWriteInternal(MCP23017_INT_ADDR, mcpRegsInt, 9, LOW);
 #endif
+*/
     // Calculate the voltage using the following formula
     // 1.1V is internal ADC reference of ESP32, 3.548133892 is 11dB in linear
     // scale (Analog signal is attenuated by 11dB before ESP32 ADC input)