81 lines
1.8 KiB
C
81 lines
1.8 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 ){
|
||
|
|
|
||
|
|
//Serial.println( "# # # # # # # # # # # # # # # # # # # # # # # # # # # # # # # # # #" );
|
||
|
|
|
||
|
|
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
|