Files
Bachelorarbeit-Rover/lib/Akku/akku.cpp
T

67 lines
1.5 KiB
C++

/**
* @file akku.cpp
* @author Alexander Klein (alex@kleiax.de)
* @brief
* @version 0.1
* @date 2022-02-05
*
* @copyright Copyright (c) 2022
*
*/
#include "akku.h"
Akku::Akku(uint8_t pin, double maxVolt, double emptyVolt) {
this->pin = pin;
this->maxVolt = maxVolt;
this->emptyVolt = emptyVolt;
this->updateOnePercent();
}
void Akku::setEmptyVoltage(double volt) {
this->emptyVolt = volt;
this->updateOnePercent();
}
void Akku::setMaxVoltage(double volt) {
this->maxVolt = volt;
this->updateOnePercent();
}
double Akku::getVoltage() {
double rawVoltage = this->readVoltage();
if (this->maxVolt) {
}
return rawVoltage;
}
uint8_t Akku::getPercent() {
uint8_t res = 0;
if (this->emptyVolt)
res = (uint8_t) ((this->getVoltage() - this->emptyVolt) / this->onePercent);
return res;
}
bool Akku::isEmpty() {
if (this->getVoltage() < this->emptyVolt) {
return true;
}
return false;
}
double Akku::readVoltage() {
// Reference voltage is 3v3 so maximum reading is 3v3 = 4095 in range 0 to 4095
double reading = analogRead(this->pin);
if(reading < 1 || reading > 4095) return 0;
return - 0.000000000000016 * pow(reading,4)
+ 0.000000000118171 * pow(reading,3)
- 0.000000301211691 * pow(reading,2)
+ 0.001109019271794 * reading
+ 0.034143524634089;
}
double Akku::updateOnePercent() {
this->onePercent = (this->maxVolt - this->emptyVolt) / 100.0;
}