130 lines
5.2 KiB
C
130 lines
5.2 KiB
C
/*
|
|
* This file is part of the MicroPython project, http://micropython.org/
|
|
*
|
|
* The MIT License (MIT)
|
|
*
|
|
* Copyright (c) 2017 Glenn Ruben Bakke
|
|
*
|
|
* 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 <stdio.h>
|
|
#include "mphalport.h"
|
|
#include "hal_adc.h"
|
|
|
|
#ifdef HAL_ADC_MODULE_ENABLED
|
|
|
|
#define ADC_REF_VOLTAGE_IN_MILLIVOLTS (1200) // Reference voltage (in milli volts) used by ADC while doing conversion.
|
|
#define ADC_PRE_SCALING_COMPENSATION (3) // The ADC is configured to use VDD with 1/3 prescaling as input. And hence the result of conversion is to be multiplied by 3 to get the actual value of the battery voltage.
|
|
#define DIODE_FWD_VOLT_DROP_MILLIVOLTS (270) // Typical forward voltage drop of the diode (Part no: SD103ATW-7-F) that is connected in series with the voltage supply. This is the voltage drop when the forward current is 1mA. Source: Data sheet of 'SURFACE MOUNT SCHOTTKY BARRIER DIODE ARRAY' available at www.diodes.com.
|
|
|
|
#define ADC_RESULT_IN_MILLI_VOLTS(ADC_VALUE)\
|
|
((((ADC_VALUE) * ADC_REF_VOLTAGE_IN_MILLIVOLTS) / 255) * ADC_PRE_SCALING_COMPENSATION)
|
|
|
|
static const uint32_t hal_adc_input_lookup[] = {
|
|
ADC_CONFIG_PSEL_AnalogInput0 << ADC_CONFIG_PSEL_Pos,
|
|
ADC_CONFIG_PSEL_AnalogInput1 << ADC_CONFIG_PSEL_Pos,
|
|
ADC_CONFIG_PSEL_AnalogInput2 << ADC_CONFIG_PSEL_Pos,
|
|
ADC_CONFIG_PSEL_AnalogInput3 << ADC_CONFIG_PSEL_Pos,
|
|
ADC_CONFIG_PSEL_AnalogInput4 << ADC_CONFIG_PSEL_Pos,
|
|
ADC_CONFIG_PSEL_AnalogInput5 << ADC_CONFIG_PSEL_Pos,
|
|
ADC_CONFIG_PSEL_AnalogInput6 << ADC_CONFIG_PSEL_Pos,
|
|
ADC_CONFIG_PSEL_AnalogInput7 << ADC_CONFIG_PSEL_Pos
|
|
};
|
|
|
|
|
|
static uint8_t battery_level_in_percent(const uint16_t mvolts)
|
|
{
|
|
uint8_t battery_level;
|
|
|
|
if (mvolts >= 3000) {
|
|
battery_level = 100;
|
|
} else if (mvolts > 2900) {
|
|
battery_level = 100 - ((3000 - mvolts) * 58) / 100;
|
|
} else if (mvolts > 2740) {
|
|
battery_level = 42 - ((2900 - mvolts) * 24) / 160;
|
|
} else if (mvolts > 2440) {
|
|
battery_level = 18 - ((2740 - mvolts) * 12) / 300;
|
|
} else if (mvolts > 2100) {
|
|
battery_level = 6 - ((2440 - mvolts) * 6) / 340;
|
|
} else {
|
|
battery_level = 0;
|
|
}
|
|
|
|
return battery_level;
|
|
}
|
|
|
|
uint16_t hal_adc_channel_value(hal_adc_config_t const * p_adc_conf) {
|
|
ADC_BASE->INTENSET = ADC_INTENSET_END_Msk;
|
|
ADC_BASE->CONFIG = (ADC_CONFIG_RES_8bit << ADC_CONFIG_RES_Pos)
|
|
| (ADC_CONFIG_INPSEL_AnalogInputTwoThirdsPrescaling << ADC_CONFIG_INPSEL_Pos)
|
|
| (ADC_CONFIG_REFSEL_VBG << ADC_CONFIG_REFSEL_Pos)
|
|
| (hal_adc_input_lookup[p_adc_conf->channel])
|
|
| (ADC_CONFIG_EXTREFSEL_None << ADC_CONFIG_EXTREFSEL_Pos);
|
|
|
|
ADC_BASE->EVENTS_END = 0;
|
|
ADC_BASE->ENABLE = ADC_ENABLE_ENABLE_Enabled;
|
|
|
|
ADC_BASE->EVENTS_END = 0;
|
|
ADC_BASE->TASKS_START = 1;
|
|
|
|
while (!ADC_BASE->EVENTS_END) {
|
|
;
|
|
}
|
|
|
|
uint8_t adc_result;
|
|
|
|
ADC_BASE->EVENTS_END = 0;
|
|
adc_result = ADC_BASE->RESULT;
|
|
ADC_BASE->TASKS_STOP = 1;
|
|
|
|
return adc_result;
|
|
}
|
|
|
|
uint16_t hal_adc_battery_level(void) {
|
|
ADC_BASE->INTENSET = ADC_INTENSET_END_Msk;
|
|
ADC_BASE->CONFIG = (ADC_CONFIG_RES_8bit << ADC_CONFIG_RES_Pos)
|
|
| (ADC_CONFIG_INPSEL_SupplyOneThirdPrescaling << ADC_CONFIG_INPSEL_Pos)
|
|
| (ADC_CONFIG_REFSEL_VBG << ADC_CONFIG_REFSEL_Pos)
|
|
| (ADC_CONFIG_PSEL_Disabled << ADC_CONFIG_PSEL_Pos)
|
|
| (ADC_CONFIG_EXTREFSEL_None << ADC_CONFIG_EXTREFSEL_Pos);
|
|
|
|
ADC_BASE->EVENTS_END = 0;
|
|
ADC_BASE->ENABLE = ADC_ENABLE_ENABLE_Enabled;
|
|
|
|
ADC_BASE->EVENTS_END = 0;
|
|
ADC_BASE->TASKS_START = 1;
|
|
|
|
while (!ADC_BASE->EVENTS_END) {
|
|
;
|
|
}
|
|
|
|
uint8_t adc_result;
|
|
uint16_t batt_lvl_in_milli_volts;
|
|
|
|
ADC_BASE->EVENTS_END = 0;
|
|
adc_result = ADC_BASE->RESULT;
|
|
ADC_BASE->TASKS_STOP = 1;
|
|
|
|
batt_lvl_in_milli_volts = ADC_RESULT_IN_MILLI_VOLTS(adc_result) + DIODE_FWD_VOLT_DROP_MILLIVOLTS;
|
|
return battery_level_in_percent(batt_lvl_in_milli_volts);
|
|
}
|
|
|
|
#endif // HAL_ADC_MODULE_ENABLED
|