1ff8c177ce
additions for feature and calculateThrottleStatus
118 lines
3.5 KiB
C++
118 lines
3.5 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>
|
|
|
|
//#define DEBUG_BATTERY
|
|
|
|
extern "C" {
|
|
#include "sensors/battery.h"
|
|
|
|
#include "io/rc_controls.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)
|
|
{
|
|
// batteryInit() reads a bunch of fields including vbatscale, so set up the config with useful initial values:
|
|
batteryConfig_t batteryConfig = {
|
|
.vbatscale = VBAT_SCALE_DEFAULT,
|
|
.vbatmaxcellvoltage = 43,
|
|
.vbatmincellvoltage = 33,
|
|
.vbatwarningcellvoltage = 35,
|
|
.currentMeterScale = 400,
|
|
.currentMeterOffset = 0,
|
|
.currentMeterType = CURRENT_SENSOR_NONE,
|
|
.multiwiiCurrentMeterOutput = 0,
|
|
.batteryCapacity = 2200,
|
|
};
|
|
|
|
batteryInit(&batteryConfig);
|
|
|
|
batteryAdcToVoltageExpectation_t batteryAdcToVoltageExpectations[] = {
|
|
{1420, 126 /*125.88*/, ELEVEN_TO_ONE_VOLTAGE_DIVIDER},
|
|
{1430, 127 /*126.76*/, ELEVEN_TO_ONE_VOLTAGE_DIVIDER},
|
|
{1440, 128 /*127.65*/, ELEVEN_TO_ONE_VOLTAGE_DIVIDER},
|
|
{1890, 168 /*167.54*/, ELEVEN_TO_ONE_VOLTAGE_DIVIDER},
|
|
{1900, 168 /*168.42*/, ELEVEN_TO_ONE_VOLTAGE_DIVIDER},
|
|
{1910, 169 /*169.31*/, ELEVEN_TO_ONE_VOLTAGE_DIVIDER},
|
|
{ 0, 0 /* 0.00*/, VBAT_SCALE_MAX},
|
|
{4096, 842 /*841.71*/, 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;
|
|
#ifdef DEBUG_BATTERY
|
|
printf("adcReading: %d, vbatscale: %d\n",
|
|
batteryAdcToVoltageExpectation->adcReading,
|
|
batteryAdcToVoltageExpectation->scale
|
|
);
|
|
#endif
|
|
uint16_t pointOneVoltSteps = batteryAdcToVoltage(batteryAdcToVoltageExpectation->adcReading);
|
|
|
|
EXPECT_EQ(batteryAdcToVoltageExpectation->expectedVoltageInDeciVoltSteps, pointOneVoltSteps);
|
|
}
|
|
}
|
|
|
|
// STUBS
|
|
|
|
extern "C" {
|
|
|
|
uint8_t armingFlags = 0;
|
|
int16_t rcCommand[4] = {0,0,0,0};
|
|
|
|
bool feature(uint32_t mask)
|
|
{
|
|
UNUSED(mask);
|
|
return false;
|
|
}
|
|
|
|
throttleStatus_e calculateThrottleStatus(rxConfig_t *rxConfig, uint16_t deadband3d_throttle)
|
|
{
|
|
UNUSED(*rxConfig);
|
|
UNUSED(deadband3d_throttle);
|
|
return THROTTLE_HIGH;
|
|
}
|
|
|
|
uint16_t adcGetChannel(uint8_t channel)
|
|
{
|
|
UNUSED(channel);
|
|
return 0;
|
|
}
|
|
|
|
void delay(uint32_t ms)
|
|
{
|
|
UNUSED(ms);
|
|
return;
|
|
}
|
|
}
|