109 lines
3.3 KiB
C++
109 lines
3.3 KiB
C++
/*
|
|
* This file is part of Cleanflight.
|
|
*
|
|
* Cleanflight is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* Cleanflight is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with Cleanflight. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
#include <stdint.h>
|
|
|
|
#include <limits.h>
|
|
|
|
extern "C" {
|
|
#include "sensors/battery.h"
|
|
}
|
|
|
|
#include "unittest_macros.h"
|
|
#include "gtest/gtest.h"
|
|
|
|
typedef struct batteryAdcToVoltageExpectation_s {
|
|
uint16_t adcReading;
|
|
uint16_t expectedVoltageInDeciVoltSteps;
|
|
uint8_t scale;
|
|
} batteryAdcToVoltageExpectation_t;
|
|
|
|
#define ELEVEN_TO_ONE_VOLTAGE_DIVIDER 110 // (10k:1k) * 10 for 0.1V
|
|
|
|
TEST(BatteryTest, BatteryADCToVoltage)
|
|
{
|
|
// given
|
|
|
|
batteryConfig_t batteryConfig = {
|
|
.vbatscale = 110,
|
|
.vbatmaxcellvoltage = 43,
|
|
.vbatmincellvoltage = 33,
|
|
.vbatwarningcellvoltage = 35,
|
|
.currentMeterScale = 400,
|
|
.currentMeterOffset = 0,
|
|
.currentMeterType = CURRENT_SENSOR_NONE,
|
|
.multiwiiCurrentMeterOutput = 0,
|
|
.batteryCapacity = 2200,
|
|
};
|
|
|
|
// batteryInit() reads a bunch of fields including vbatscale, so set up the config with useful initial values:
|
|
memset(&batteryConfig, 0, sizeof(batteryConfig));
|
|
|
|
batteryConfig.vbatmaxcellvoltage = 43;
|
|
batteryConfig.vbatmincellvoltage = 33;
|
|
batteryConfig.vbatwarningcellvoltage = 35;
|
|
batteryConfig.vbatscale = VBAT_SCALE_DEFAULT;
|
|
|
|
batteryInit(&batteryConfig);
|
|
|
|
batteryAdcToVoltageExpectation_t batteryAdcToVoltageExpectations[] = {
|
|
{1420, 125, ELEVEN_TO_ONE_VOLTAGE_DIVIDER},
|
|
{1430, 126, ELEVEN_TO_ONE_VOLTAGE_DIVIDER},
|
|
{1440, 127, ELEVEN_TO_ONE_VOLTAGE_DIVIDER},
|
|
{1890, 167, ELEVEN_TO_ONE_VOLTAGE_DIVIDER},
|
|
{1900, 168, ELEVEN_TO_ONE_VOLTAGE_DIVIDER},
|
|
{1910, 169, ELEVEN_TO_ONE_VOLTAGE_DIVIDER},
|
|
{ 0, 0, VBAT_SCALE_MAX},
|
|
{4096, 841, VBAT_SCALE_MAX}
|
|
};
|
|
uint8_t testIterationCount = sizeof(batteryAdcToVoltageExpectations) / sizeof(batteryAdcToVoltageExpectation_t);
|
|
|
|
// expect
|
|
|
|
for (uint8_t index = 0; index < testIterationCount; index ++) {
|
|
batteryAdcToVoltageExpectation_t *batteryAdcToVoltageExpectation = &batteryAdcToVoltageExpectations[index];
|
|
batteryConfig.vbatscale = batteryAdcToVoltageExpectation->scale;
|
|
printf("adcReading: %d, vbatscale: %d\n",
|
|
batteryAdcToVoltageExpectation->adcReading,
|
|
batteryAdcToVoltageExpectation->scale
|
|
);
|
|
|
|
uint16_t pointOneVoltSteps = batteryAdcToVoltage(batteryAdcToVoltageExpectation->adcReading);
|
|
|
|
EXPECT_EQ(pointOneVoltSteps, batteryAdcToVoltageExpectation->expectedVoltageInDeciVoltSteps);
|
|
}
|
|
}
|
|
|
|
// STUBS
|
|
|
|
extern "C" {
|
|
|
|
uint8_t armingFlags = 0;
|
|
int16_t rcCommand[4] = {0,0,0,0};
|
|
|
|
uint16_t adcGetChannel(uint8_t channel)
|
|
{
|
|
UNUSED(channel);
|
|
return 0;
|
|
}
|
|
|
|
void delay(uint32_t ms)
|
|
{
|
|
UNUSED(ms);
|
|
return;
|
|
}
|
|
}
|