155 lines
5.2 KiB
C++
155 lines
5.2 KiB
C++
/*
|
|
MIT License
|
|
|
|
Copyright (c) 2019 Pangodream
|
|
|
|
Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
of this software and associated documentation files (the "Software"), to deal
|
|
in the Software without restriction, including without limitation the rights
|
|
to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
copies of the Software, and to permit persons to whom the Software is
|
|
furnished to do so, subject to the following conditions:
|
|
|
|
The above copyright notice and this permission notice shall be included in all
|
|
copies or substantial portions of the Software.
|
|
|
|
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
|
SOFTWARE.
|
|
*/
|
|
#include "Arduino.h"
|
|
#include "Pangodream_18650_CL.h"
|
|
|
|
Pangodream_18650_CL::Pangodream_18650_CL(int addressPin, double convFactor, int reads)
|
|
{
|
|
_reads = reads;
|
|
_convFactor = convFactor;
|
|
_addressPin = addressPin;
|
|
_initVoltsArray();
|
|
}
|
|
|
|
Pangodream_18650_CL::Pangodream_18650_CL(int addressPin, double convFactor)
|
|
{
|
|
_reads = DEF_READS;
|
|
_convFactor = convFactor;
|
|
_addressPin = addressPin;
|
|
_initVoltsArray();
|
|
}
|
|
|
|
Pangodream_18650_CL::Pangodream_18650_CL(int addressPin)
|
|
{
|
|
_reads = DEF_READS;
|
|
_convFactor = DEF_CONV_FACTOR;
|
|
_addressPin = addressPin;
|
|
_initVoltsArray();
|
|
}
|
|
|
|
Pangodream_18650_CL::Pangodream_18650_CL()
|
|
{
|
|
_reads = DEF_READS;
|
|
_convFactor = DEF_CONV_FACTOR;
|
|
_addressPin = DEF_PIN;
|
|
_initVoltsArray();
|
|
}
|
|
|
|
int Pangodream_18650_CL::getAnalogPin()
|
|
{
|
|
return _addressPin;
|
|
}
|
|
double Pangodream_18650_CL::getConvFactor()
|
|
{
|
|
return _convFactor;
|
|
}
|
|
|
|
/**
|
|
* Loads each voltage value in its matching charge element (index)
|
|
*/
|
|
void Pangodream_18650_CL::_initVoltsArray(){
|
|
_vs[0] = 7.800;
|
|
_vs[1] = 7.848; _vs[2] = 7.896; _vs[3] = 7.944; _vs[4] = 7.992; _vs[5] = 8.040;
|
|
_vs[6] = 8.088; _vs[7] = 8.136; _vs[8] = 8.184; _vs[9] = 8.232; _vs[10] = 8.280;
|
|
_vs[11] = 8.328; _vs[12] = 8.376; _vs[13] = 8.424; _vs[14] = 8.472; _vs[15] = 8.520;
|
|
_vs[16] = 8.568; _vs[17] = 8.616; _vs[18] = 8.664; _vs[19] = 8.712; _vs[20] = 8.760;
|
|
_vs[21] = 8.808; _vs[22] = 8.856; _vs[23] = 8.904; _vs[24] = 8.952; _vs[25] = 9.000;
|
|
_vs[26] = 9.048; _vs[27] = 9.096; _vs[28] = 9.144; _vs[29] = 9.192; _vs[30] = 9.240;
|
|
_vs[31] = 9.288; _vs[32] = 9.336; _vs[33] = 9.384; _vs[34] = 9.432; _vs[35] = 9.480;
|
|
_vs[36] = 9.528; _vs[37] = 9.576; _vs[38] = 9.624; _vs[39] = 9.672; _vs[40] = 9.720;
|
|
_vs[41] = 9.768; _vs[42] = 9.816; _vs[43] = 9.864; _vs[44] = 9.912; _vs[45] = 9.960;
|
|
_vs[46] = 10.008; _vs[47] = 10.056; _vs[48] = 10.104; _vs[49] = 10.152; _vs[50] = 10.200;
|
|
_vs[51] = 10.248; _vs[52] = 310.296; _vs[53] = 10.344; _vs[54] = 10.392; _vs[55] = 10.440;
|
|
_vs[56] = 10.488; _vs[57] = 10.536; _vs[58] = 10.584; _vs[59] = 10.632; _vs[60] = 10.680;
|
|
_vs[61] = 10.728; _vs[62] = 10.776; _vs[63] = 10.824; _vs[64] = 10.872; _vs[65] = 10.920;
|
|
_vs[66] = 10.968; _vs[67] = 11.016; _vs[68] = 11.064; _vs[69] = 11.112; _vs[70] = 11.160;
|
|
_vs[71] = 11.208; _vs[72] = 11.256; _vs[73] = 11.304; _vs[74] = 11.352; _vs[75] = 11.400;
|
|
_vs[76] = 11.448; _vs[77] = 11.496; _vs[78] = 11.544; _vs[79] = 11.592; _vs[80] = 11.640;
|
|
_vs[81] = 11.688; _vs[82] = 11.736; _vs[83] = 11.784; _vs[84] = 11.832; _vs[85] = 11.880;
|
|
_vs[86] = 11.928; _vs[87] = 11.976; _vs[88] = 12.024; _vs[89] = 12.072; _vs[90] = 12.120;
|
|
_vs[91] = 12.168; _vs[92] = 12.216; _vs[93] = 12.264; _vs[94] = 12.312; _vs[95] = 12.360;
|
|
_vs[96] = 12.408; _vs[97] = 12.456; _vs[98] = 12.504; _vs[99] = 12.552; _vs[100] = 12.600;
|
|
}
|
|
|
|
int Pangodream_18650_CL::getBatteryChargeLevel()
|
|
{
|
|
int readValue = _analogRead(_addressPin);
|
|
double volts = _analogReadToVolts(readValue);
|
|
int chargeLevel = _getChargeLevel(volts);
|
|
return chargeLevel;
|
|
}
|
|
|
|
int Pangodream_18650_CL::pinRead(){
|
|
return _analogRead(_addressPin);
|
|
}
|
|
|
|
int Pangodream_18650_CL::_analogRead(int pinNumber){
|
|
int totalValue = 0;
|
|
int averageValue = 0;
|
|
for(int i = 0; i < _reads; i++){
|
|
totalValue += analogRead(pinNumber);
|
|
}
|
|
averageValue = totalValue / _reads;
|
|
return averageValue;
|
|
}
|
|
/**
|
|
* Performs a binary search to find the index corresponding to a voltage.
|
|
* The index of the array is the charge %
|
|
*/
|
|
int Pangodream_18650_CL::_getChargeLevel(double volts){
|
|
int idx = 50;
|
|
int prev = 0;
|
|
int half = 0;
|
|
if (volts >= 12.6){
|
|
return 100;
|
|
}
|
|
if (volts <= 7.8){
|
|
return 0;
|
|
}
|
|
while(true){
|
|
half = abs(idx - prev) / 2;
|
|
prev = idx;
|
|
if(volts >= _vs[idx]){
|
|
idx = idx + half;
|
|
}else{
|
|
idx = idx - half;
|
|
}
|
|
if (prev == idx){
|
|
break;
|
|
}
|
|
}
|
|
return idx;
|
|
}
|
|
|
|
double Pangodream_18650_CL::_analogReadToVolts(int readValue){
|
|
double volts;
|
|
volts = readValue * _convFactor / 1000;
|
|
return volts;
|
|
}
|
|
|
|
double Pangodream_18650_CL::getBatteryVolts(){
|
|
int readValue = analogRead(_addressPin);
|
|
return _analogReadToVolts(readValue);
|
|
}
|