M5 battery monitor improved (read IP5306 chip)

This commit is contained in:
Klaus K Wilting 2020-04-19 19:51:23 +02:00
parent 53be14d8a6
commit 2624f7b35b
8 changed files with 128 additions and 26 deletions

View File

@ -36,6 +36,13 @@ void AXP192_showstatus(void);
#endif // HAS_PMU
#ifdef HAS_IP5306
void printIP5306Stats(void);
uint8_t IP5306_GetPowerSource(void);
uint8_t IP5306_GetBatteryLevel(void);
uint8_t IP5306_GetBatteryFull(void);
#endif
// The following map functions were taken from
//
// Battery.h - Battery library
@ -48,16 +55,21 @@ void AXP192_showstatus(void);
*
* c - c / (1 + k*x/v)^3
*/
static inline uint8_t sigmoidal(uint16_t voltage, uint16_t minVoltage, uint16_t maxVoltage) {
// slow
// uint8_t result = 110 - (110 / (1 + pow(1.468 * (voltage - minVoltage)/(maxVoltage - minVoltage), 6)));
static inline uint8_t sigmoidal(uint16_t voltage, uint16_t minVoltage,
uint16_t maxVoltage) {
// slow
// uint8_t result = 110 - (110 / (1 + pow(1.468 * (voltage -
// minVoltage)/(maxVoltage - minVoltage), 6)));
// steep
// uint8_t result = 102 - (102 / (1 + pow(1.621 * (voltage - minVoltage)/(maxVoltage - minVoltage), 8.1)));
// steep
// uint8_t result = 102 - (102 / (1 + pow(1.621 * (voltage -
// minVoltage)/(maxVoltage - minVoltage), 8.1)));
// normal
uint8_t result = 105 - (105 / (1 + pow(1.724 * (voltage - minVoltage)/(maxVoltage - minVoltage), 5.5)));
return result >= 100 ? 100 : result;
// normal
uint8_t result = 105 - (105 / (1 + pow(1.724 * (voltage - minVoltage) /
(maxVoltage - minVoltage),
5.5)));
return result >= 100 ? 100 : result;
}
/**
@ -66,9 +78,13 @@ static inline uint8_t sigmoidal(uint16_t voltage, uint16_t minVoltage, uint16_t
*
* c - c / [1 + (k*x/v)^4.5]^3
*/
static inline uint8_t asigmoidal(uint16_t voltage, uint16_t minVoltage, uint16_t maxVoltage) {
uint8_t result = 101 - (101 / pow(1 + pow(1.33 * (voltage - minVoltage)/(maxVoltage - minVoltage) ,4.5), 3));
return result >= 100 ? 100 : result;
static inline uint8_t asigmoidal(uint16_t voltage, uint16_t minVoltage,
uint16_t maxVoltage) {
uint8_t result = 101 - (101 / pow(1 + pow(1.33 * (voltage - minVoltage) /
(maxVoltage - minVoltage),
4.5),
3));
return result >= 100 ? 100 : result;
}
/**
@ -77,8 +93,10 @@ static inline uint8_t asigmoidal(uint16_t voltage, uint16_t minVoltage, uint16_t
*
* x * 100 / v
*/
static inline uint8_t linear(uint16_t voltage, uint16_t minVoltage, uint16_t maxVoltage) {
return (unsigned long)(voltage - minVoltage) * 100 / (maxVoltage - minVoltage);
static inline uint8_t linear(uint16_t voltage, uint16_t minVoltage,
uint16_t maxVoltage) {
return (unsigned long)(voltage - minVoltage) * 100 /
(maxVoltage - minVoltage);
}
uint8_t read_battlevel(mapFn_t mapFunction = &sigmoidal);

View File

@ -65,12 +65,14 @@ void doHousekeeping() {
#endif
// read battery voltage into global variable
#if (defined BAT_MEASURE_ADC || defined HAS_PMU)
#if (defined BAT_MEASURE_ADC || defined HAS_PMU || defined HAS_IP5306)
batt_level = read_battlevel();
ESP_LOGI(TAG, "Battery: %d%%", batt_level);
#ifdef HAS_PMU
AXP192_showstatus();
#endif
#ifdef HAS_IP5306
printIP5306Stats();
#endif
#endif
// display BME680/280 sensor data

View File

@ -280,7 +280,7 @@ void dp_drawPage(time_t t, bool nextpage) {
// line 4: Battery + GPS status + Wifi channel
// B:a.bcV Sats:ab ch:ab
#if (defined BAT_MEASURE_ADC || defined HAS_PMU)
#if (defined BAT_MEASURE_ADC || defined HAS_PMU || defined HAS_IP5306)
if (batt_level == 0)
dp_printf("No batt ");
else if (batt_level < 100)
@ -290,6 +290,7 @@ void dp_drawPage(time_t t, bool nextpage) {
#else
dp_printf(" ");
#endif
#if (HAS_GPS)
dp_setFont(MY_FONT_SMALL, !gps_hasfix());
dp_printf("Sats:%.2d", gps.satellites.value());

View File

@ -34,12 +34,12 @@
#define HAS_DISPLAY 2 // TFT-LCD, support work in progess, not ready yet
//#define MY_DISPLAY_FLIP 1 // use if display is rotated
//#define BAT_MEASURE_ADC ADC1_GPIO35_CHANNEL // battery probe GPIO pin -> ADC1_CHANNEL_7
//#define BAT_VOLTAGE_DIVIDER 2 // voltage divider 100k/100k on board
#define HAS_LED NOT_A_PIN // no on board LED (?)
#define HAS_BUTTON (39) // on board button A
#define HAS_IP5306 1
// GPS settings
#define HAS_GPS 1 // use on board GPS
#define GPS_SERIAL 9600, SERIAL_8N1, RXD2, TXD2 // UBlox NEO 6M RX, TX

View File

@ -34,8 +34,6 @@
#define HAS_DISPLAY 2 // TFT-LCD, support work in progess, not ready yet
//#define MY_DISPLAY_FLIP 1 // use if display is rotated
//#define BAT_MEASURE_ADC ADC1_GPIO35_CHANNEL // battery probe GPIO pin -> ADC1_CHANNEL_7
//#define BAT_VOLTAGE_DIVIDER 2 // voltage divider 100k/100k on board
#define HAS_LED NOT_A_PIN // no on board LED (?)
#define RGB_LED_COUNT 10
@ -43,6 +41,8 @@
#define HAS_RGB_LED SmartLed rgb_led(LED_SK6812, RGB_LED_COUNT, GPIO_NUM_15) // LED_SK6812 RGB LED on GPIO15
#define HAS_BUTTON (39) // on board button A
#define HAS_IP5306 1
// GPS settings
#define HAS_GPS 0 // use on board GPS
#define GPS_SERIAL 9600, SERIAL_8N1, RXD2, TXD2 // UBlox NEO 6M RX, TX

View File

@ -492,6 +492,9 @@ uint8_t myBattLevelCb(void *pUserData) {
#ifdef HAS_PMU
if (pmu.isVBUSPlug())
lmic_batt_level = MCMD_DEVS_EXT_POWER;
#elif defined HAS_IP5306
if (IP5306_GetPowerSource())
lmic_batt_level = MCMD_DEVS_EXT_POWER;
#else
if (batt_percent >= 100)
lmic_batt_level = MCMD_DEVS_EXT_POWER;

View File

@ -258,10 +258,13 @@ void setup() {
#endif
// initialize battery status
#if (defined BAT_MEASURE_ADC || defined HAS_PMU)
#if (defined BAT_MEASURE_ADC || defined HAS_PMU || defined HAS_IP5306)
strcat_P(features, " BATT");
calibrate_voltage();
batt_level = read_battlevel();
#ifdef HAS_IP5306
printIP5306Stats();
#endif
#endif
#if (USE_OTA)

View File

@ -215,6 +215,10 @@ uint8_t read_battlevel(mapFn_t mapFunction) {
// returns the estimated battery level in values 0 ... 100 [percent]
uint8_t batt_percent;
#ifdef HAS_IP5306
batt_percent = IP5306_GetBatteryLevel();
#else
const uint16_t batt_voltage = read_voltage();
if (batt_voltage <= BAT_MIN_VOLTAGE)
@ -224,17 +228,88 @@ uint8_t read_battlevel(mapFn_t mapFunction) {
else
batt_percent =
(*mapFunction)(batt_voltage, BAT_MIN_VOLTAGE, BAT_MAX_VOLTAGE);
ESP_LOGD(TAG, "batt_voltage = %dmV / batt_percent = %d%%", batt_voltage,
batt_percent);
#endif // HAS_IP5306
return batt_percent;
}
bool batt_sufficient() {
#if (defined HAS_PMU || defined BAT_MEASURE_ADC)
#if (defined HAS_PMU || defined BAT_MEASURE_ADC || defined HAS_IP5306)
return (batt_level > OTA_MIN_BATT);
#else
return true; // we don't know batt level
#endif
}
#ifdef HAS_IP5306
// IP5306 code snippet was taken from
// https://gist.github.com/me-no-dev/7702f08dd578de5efa47caf322250b57
#define IP5306_REG_SYS_0 0x00
#define IP5306_REG_SYS_1 0x01
#define IP5306_REG_SYS_2 0x02
#define IP5306_REG_CHG_0 0x20
#define IP5306_REG_CHG_1 0x21
#define IP5306_REG_CHG_2 0x22
#define IP5306_REG_CHG_3 0x23
#define IP5306_REG_CHG_4 0x24
#define IP5306_REG_READ_0 0x70
#define IP5306_REG_READ_1 0x71
#define IP5306_REG_READ_2 0x72
#define IP5306_REG_READ_3 0x77
#define IP5306_REG_READ_4 0x78
#define IP5306_LEDS2PCT(byte) \
((byte & 0x01 ? 25 : 0) + (byte & 0x02 ? 25 : 0) + (byte & 0x04 ? 25 : 0) + \
(byte & 0x08 ? 25 : 0))
uint8_t ip5306_get_bits(uint8_t reg, uint8_t index, uint8_t bits) {
uint8_t value;
if (i2c_readBytes(0x75, reg, &value, 1) == 0xff) {
ESP_LOGW(TAG, "IP5306 get bits fail: 0x%02x", reg);
return 0;
}
return (value >> index) & ((1 << bits) - 1);
}
void ip5306_set_bits(uint8_t reg, uint8_t index, uint8_t bits, uint8_t value) {
uint8_t mask = (1 << bits) - 1, v;
if (i2c_readBytes(0x75, reg, &v, 1) == 0xff) {
ESP_LOGW(TAG, "IP5306 register read fail: 0x%02x", reg);
return;
}
v &= ~(mask << index);
v |= ((value & mask) << index);
if (i2c_writeBytes(0x75, reg, &v, 1) == 0xff)
ESP_LOGW(TAG, "IP5306 register write fail: 0x%02x", reg);
}
uint8_t IP5306_GetPowerSource(void) {
ip5306_get_bits(IP5306_REG_READ_0, 3, 1); // 0:BAT, 1:VIN
}
uint8_t IP5306_GetBatteryFull(void) {
ip5306_get_bits(IP5306_REG_READ_1, 3, 1); // 0:CHG/DIS, 1:FULL
}
uint8_t IP5306_GetBatteryLevel(void) {
uint8_t state = (~ip5306_get_bits(IP5306_REG_READ_4, 4, 4)) & 0x0F;
// LED[0-4] State (inverted)
return IP5306_LEDS2PCT(state);
}
void printIP5306Stats(void) {
bool usb = IP5306_GetPowerSource();
bool full = IP5306_GetBatteryFull();
uint8_t leds = IP5306_GetBatteryLevel();
ESP_LOGI(TAG,
"IP5306: Power Source: %s, Battery State: %s, Battery "
"Level: %u%%",
usb ? "USB" : "BATTERY",
full ? "CHARGED" : (usb ? "CHARGING" : "DISCHARGING"),
IP5306_LEDS2PCT(leds));
}
#endif // HAS_IP5306