status.c

#include "epicardium.h"
#include "modules/modules.h"
#include "modules/log.h"

#include "portexpander.h"
#include "MAX77650-Arduino-Library.h"
#include "FreeRTOS.h"
#include "timers.h"

#include <stdio.h>
#include <stdint.h>
#define POWERLED 10
#define FREQ 100
#define PULSEWIDTH 2
#define PULSELENGTH 10

static uint8_t power_status = 0; // 0: discharging, 1: below 3.8V, 2: below 3.6V, 254: charging, 255: full and connected to charger, 128: charge error, 127: undefined
static float bat_volt = 0;
static float bat_cur = 0;
static float char_volt = 0;
static float char_cur = 0;
static bool power_led_on = true;

static TimerHandle_t status_timer;
static StaticTimer_t status_timer_buffer;

static void get_power_status(){
	epic_read_battery_voltage(&bat_volt);
	epic_read_battery_current(&bat_cur);
	epic_read_chargein_voltage(&char_volt);
	epic_read_chargein_current(&char_cur);

	if(char_volt > 4){
		if(char_cur > 0.1){
			power_status = 254;
		} else {
			if(bat_volt>4.1){
				power_status = 255;
			} else {
				power_status = 128;
			}
		}
	} else if(bat_volt>3.8){
		power_status = 0;
	} else if(bat_volt>3.6){
		power_status = 1;
	} else {
		power_status = 2;
	}
}

static void update_power_led(){
	static uint8_t counter = 0;
	static uint8_t old_power_status = 127;
	if(old_power_status == power_status && power_status != 2){
		return;
	}
	switch(power_status){
		case 0: 
		case 1:
			epic_leds_set(POWERLED,0,0,0);
			return;
		case 254: 
			epic_leds_set(POWERLED,0,0,200);
			return;
		case 255: 
			epic_leds_set(POWERLED,0,200,0);
			return;
		case 2: 
			if(counter<PULSEWIDTH){
				epic_leds_set(POWERLED,200,0,0);
			} else {
				epic_leds_set(POWERLED,0,0,0);
			}	
			counter++;
			counter = counter % PULSELENGTH;
		}
	old_power_status = power_status;
}

static void CALLBACK_led(){
	get_power_status();
	if(power_led_on){
		update_power_led();
	}
}

void epic_status_start(){
	if(!status_timer) {
		status_timer = xTimerCreateStatic(
				"status_led",
				FREQ,
				pdTRUE,
				NULL,
				CALLBACK_led,
				&status_timer_buffer
		);
		xTimerStart(status_timer, 0);
	}
}

uint8_t epic_status_get_power_status(){
	if (!status_timer || !xTimerIsTimerActive(status_timer)) {
		return -ENODATA;
	}
	return power_status;
}

void epic_status_stop(){
	if (!status_timer || xTimerIsTimerActive(status_timer) == pdFALSE) { return; }
	xTimerStop(status_timer, 0);
}

void epic_status_power_led(bool onoff){
	power_led_on = onoff;
}