77 lines
1.7 KiB
C++
77 lines
1.7 KiB
C++
/*
|
|
TemperatureDecoupler.h
|
|
SmartCitizen
|
|
|
|
Created by Oriol Ferrer Mesià on 03/06/13.
|
|
*/
|
|
|
|
#ifndef SmartCitizen_TemperatureDecoupler_h
|
|
#define SmartCitizen_TemperatureDecoupler_h
|
|
|
|
#define BATTERY_HEATUP_MAX 11
|
|
#define BATTERY_CHARGE_THRESHOLD 980
|
|
#include <Arduino.h>
|
|
#include "AccumulatorFilter.h"
|
|
|
|
|
|
class TemperatureDecoupler{
|
|
|
|
public:
|
|
|
|
void setup(){
|
|
_prevBattery = 0;
|
|
filter.setup(0.3);
|
|
}
|
|
|
|
void update( uint16_t battery ){
|
|
bool charging = false;
|
|
bool doNothing = false;
|
|
if (battery == _prevBattery){
|
|
//doNothing;
|
|
if ( battery > BATTERY_CHARGE_THRESHOLD ){
|
|
charging = true;
|
|
//Serial.println( "Battery same val > 980! charging!");
|
|
}else{
|
|
charging = false;
|
|
//Serial.println( "Battery same val < 980! NOT charging!");
|
|
}
|
|
}else{
|
|
if ( battery > _prevBattery || battery > BATTERY_CHARGE_THRESHOLD ){ //battery is charging!
|
|
//Serial.println( "Battery charging!");
|
|
charging = true;
|
|
}else{ //battery is being drained
|
|
//Serial.println( "Battery dis-charging!");
|
|
charging = false;
|
|
}
|
|
}
|
|
|
|
if (!doNothing){
|
|
if(charging)
|
|
filter.goUp();
|
|
else
|
|
filter.goDown();
|
|
}
|
|
|
|
//Serial.print(F("battery: ")); Serial.println( battery );
|
|
//Serial.print(F("_prevBattery: ")); Serial.println( _prevBattery );
|
|
//Serial.print(F("filter: ")); Serial.println( filter.getVal() );
|
|
|
|
//Serial.println( "# # # # # # # # # # # # # # # # # # # # # # # # # # # # # # # # # #" );
|
|
//store last bat reading for future comparing
|
|
_prevBattery = battery;
|
|
lastChargingState = charging;
|
|
}
|
|
|
|
short int getCompensation(){
|
|
return (short int) (filter.getVal() * BATTERY_HEATUP_MAX);
|
|
}
|
|
|
|
short int _prevBattery;
|
|
AccumulatorFilter filter;
|
|
bool lastChargingState; //true == up, false == down
|
|
|
|
};
|
|
|
|
|
|
#endif
|