#include "battery.h"
#include "driver/backlight.h"
#include "misc.h"

uint16_t gBatteryCalibration[6];
uint16_t gBatteryBootVoltage;
uint16_t gBatteryCurrent;
uint16_t gBatteryVoltages[4];
uint16_t gBatteryVoltageAverage;

uint8_t gBatteryDisplayLevel;

bool gChargingWithTypeC;
bool gMaybeLowBatteryWarning;

void BATTERY_GetReadings(bool bDisplayBatteryLevel)
{
	uint16_t Voltage;
	uint8_t PreviousBatteryLevel;

	PreviousBatteryLevel = gBatteryDisplayLevel;

	Voltage = (gBatteryVoltages[0] + gBatteryVoltages[1] + gBatteryVoltages[2] + gBatteryVoltages[3]) / 4;

	if (gBatteryCalibration[5] < Voltage) {
		gBatteryDisplayLevel = 6;
	} else if (gBatteryCalibration[4] < Voltage) {
		gBatteryDisplayLevel = 5;
	} else if (gBatteryCalibration[3] < Voltage) {
		gBatteryDisplayLevel = 4;
	} else if (gBatteryCalibration[2] < Voltage) {
		gBatteryDisplayLevel = 3;
	} else if (gBatteryCalibration[1] < Voltage) {
		gBatteryDisplayLevel = 2;
	} else if (gBatteryCalibration[0] < Voltage) {
		gBatteryDisplayLevel = 1;
	} else {
		gBatteryDisplayLevel = 0;
	}

	gBatteryVoltageAverage = (Voltage * 760) / gBatteryCalibration[3];

#if 0
	if ((gScreenToDisplay == MENU) && (gMenuCursor == MENU_VOL)) {
		DAT_20000370 = 1;
	}
#endif
	if (gBatteryCurrent < 501) {
		if (gChargingWithTypeC) {
			g_2000036F = 1;
		}
		gChargingWithTypeC = 0;
	} else {
		if (gChargingWithTypeC == false) {
			g_2000036F = 1;
			BACKLIGHT_TurnOn();
		}
		gChargingWithTypeC = 1;
	}

	if (PreviousBatteryLevel != gBatteryDisplayLevel) {
		if (gBatteryDisplayLevel < 2) {
			gMaybeLowBatteryWarning = 1;
		} else {
			gMaybeLowBatteryWarning = 0;
			if (bDisplayBatteryLevel) {
#if 0
				GUI_DisplayBatteryLevel(gBatteryDisplayLevel);
#endif
			}
		}
#if 0
		//DAT_20000400 = 0;
#endif
	}
}