#include "battery.h"
-#if defined(CONFIG_ADC_SUPPORT_AFE)
-
-
-#define ADC_AUTO_SAMPLE_TEST_TIMES 1000
-#define HADC_DEFAULT_CALI \
-{ \
- .hadc_os_code = 0x68, \
- .hadc_wt_b22 = 0x75fdd, \
- .hadc_wt_b21 = 0x3ef67, \
- .hadc_wt_b20 = 0x1f7ae, \
- .hadc_wt_b19 = 0xfc3d, \
- .hadc_wt_b18 = 0x7e22, \
- .hadc_wt_b17 = 0x7dc9, \
- .hadc_wt_b16 = 0x3f01, \
- .hadc_wt_b15 = 0x1f80, \
- .hadc_wt_b14 = 0xfc5, \
- .hadc_wt_b13 = 0x800, \
- .hadc_wt_b12 = 0x800, \
- .hadc_wt_b11 = 0x400, \
- .hadc_wt_b10 = 0x200, \
- .hadc_wt_b9 = 0x100, \
- .dac_code1 = 0x200, \
- .dac_code2 = 0x1d5, \
-}
-
-afe_config_t g_afe_config = HADC_DEFAULT_CALI;
-static bool g_afe_open_flag = false;
-
-static int gadc_open_test(int argc, char *argv[])
-{
- if (argc < 1) {
- return SUITE_ERROR_BAD_PARAMS;
- }
- adc_v152_gadc_channel_sel_t gadc_channel = (adc_v152_gadc_channel_sel_t)strtol(argv[0], NULL, 0);
- if (gadc_channel > SINGLE_END_AINN4) {
- return SUITE_ERROR_BAD_PARAMS;
- }
- errcode_t ret = uapi_adc_init(ADC_CLOCK_NONE);
- if (ret != ERRCODE_SUCC) {
- return ret;
- }
- uapi_adc_open_channel(gadc_channel);
- uapi_adc_power_en(AFE_GADC_MODE, true);
- adc_calibration(AFE_GADC_MODE, true, false, false);
- hadc_gain_set(PGA_GAIN_EIGHT, IA_GAIN_SIXTEEN);
- uapi_adc_manual_sample((adc_channel_t)AFE_GADC_MODE);
- g_afe_open_flag = true;
- return SUITE_OK;
-}
-
-static int hadc_open_test(int argc, char *argv[])
-{
- UNUSED(argc);
- UNUSED(argv);
- bool cali_en = (bool)strtol(argv[0], NULL, 0);
- errcode_t ret = uapi_adc_init(ADC_CLOCK_NONE);
- if (ret != ERRCODE_SUCC) {
- return ret;
- }
- uapi_adc_power_en(AFE_HADC_MODE, true);
- if (cali_en) {
- adc_calibration(AFE_HADC_MODE, true, true, true);
- g_afe_config.hadc_os_code = reg32(0x57036244); // hadc_os_code
- g_afe_config.hadc_wt_b22 = reg32(0x570361B0); // hadc_wt_b22
- g_afe_config.hadc_wt_b21 = reg32(0x570361B4); // hadc_wt_b21
- g_afe_config.hadc_wt_b20 = reg32(0x570361B8); // hadc_wt_b20
- g_afe_config.hadc_wt_b19 = reg32(0x570361BC); // hadc_wt_b19
- g_afe_config.hadc_wt_b18 = reg32(0x570361C0); // hadc_wt_b18
- g_afe_config.hadc_wt_b17 = reg32(0x570361C4); // hadc_wt_b17
- g_afe_config.hadc_wt_b16 = reg32(0x570361C8); // hadc_wt_b16
- g_afe_config.hadc_wt_b15 = reg32(0x570361CC); // hadc_wt_b15
- g_afe_config.hadc_wt_b14 = reg32(0x570361D0); // hadc_wt_b14
- g_afe_config.hadc_wt_b13 = reg32(0x570361D4); // hadc_wt_b13
- g_afe_config.hadc_wt_b12 = reg32(0x570361D8); // hadc_wt_b12
- g_afe_config.hadc_wt_b11 = reg32(0x570361DC); // hadc_wt_b11
- g_afe_config.hadc_wt_b10 = reg32(0x570361E0); // hadc_wt_b10
- g_afe_config.hadc_wt_b9 = reg32(0x570361E4); // hadc_wt_b9
- g_afe_config.dac_code1 = reg32(0x570363D4); // dac_code1
- g_afe_config.dac_code2 = reg32(0x570363D8); // dac_code2
- } else {
- afe_config_t afe_config = g_afe_config;
- adc_set_cali_code(AFE_HADC_MODE, &afe_config);
- }
- uapi_adc_manual_sample(HADC_CHANNEL_0);
- g_afe_open_flag = true;
- return SUITE_OK;
-}
-
-static int adc_auto_sample_test(int argc, char *argv[])
-{
- if (argc < 1) {
- return SUITE_ERROR_BAD_PARAMS;
- }
- if (!g_afe_open_flag) {
- return SUITE_TEST_FAILED;
- }
- adc_v152_gadc_channel_sel_t channel = (adc_v152_gadc_channel_sel_t)strtol(argv[0], NULL, 0);
- uapi_adc_open_channel(channel);
- int adc_value = 0;
- adc_channel_t ch = channel <= SINGLE_END_AINN4 ? (adc_channel_t)AFE_GADC_MODE : HADC_CHANNEL_0;
- uint32_t irq_sts = osal_irq_lock();
- for (int i = 0; i < ADC_AUTO_SAMPLE_TEST_TIMES; i++) {
- adc_value = uapi_adc_auto_sample(ch);
- suite_log_stringf("adc: 0x%x = %d\n", adc_value, adc_value);
- }
- UNUSED(adc_value);
- osal_irq_restore(irq_sts);
- return SUITE_OK;
-}
-
-static int hadc_power_on(int argc, char *argv[])
-{
- UNUSED(argc);
- UNUSED(argv);
- uapi_adc_power_en(AFE_HADC_MODE, true);
- adc_set_cali_code(AFE_HADC_MODE, &g_afe_config);
- return SUITE_OK;
-}
-
-static int hadc_power_off(int argc, char *argv[])
-{
- UNUSED(argc);
- UNUSED(argv);
- uapi_adc_power_en(AFE_HADC_MODE, false);
- return SUITE_OK;
-}
-
-#else
#define HAL_ADC_SAMPLE_NUMBER_CONFIG_0 10 /* Channel with buffer manual sample average number. */
#define HAL_ADC_SAMPLE_NUMBER_CONFIG_1 10 /* Channel without buffer manual sample average number. */
#define HAL_ADC_DISCARD_NUMBER_CONFIG_0 8 /* Channel with buffer manual sample discard number. */
#define adc_trans_sytick_to_voltage(x) ((float)(((float)(x) * 17) / 40960))
#define adc_trans_sytick_to_voltage_diff(x) ((float)(((float)((x) - 2048) * 17) / 20480))
// #define adc_trans_sytick_to_voltage_without_auto_scan(x) ((float)(((float)(x) * 18) / 40960))
-#define adc_trans_sytick_to_voltage_without_auto_scan(x) ((float)(((float)(x) * 18) / 40960))
+#define adc_trans_sytick_to_voltage_without_auto_scan(x) ((float)((float)(x) / 749.75838433852f))
+#define BATTERY_VOLTAGE_MAX (4.2f)
+#define BATTERY_VOLTAGE_MIN (3.2f)
static uint32_t g_adc_sample_times = 0;
static uint32_t g_adc_sample_discard = 0;
static float adc_stick_transfer_voltage(uint16_t stick, adc_channel_t channel)
{
-#if defined(CONFIG_ADC_SUPPORT_AUTO_SCAN)
- hal_adc_type_info_t *adc_cfg_info = NULL;
- adc_cfg_info = adc_port_get_cfg();
- /* diff channel: (stick - 2048)/ 2048 * 1.8 ; */
- if (adc_cfg_info != NULL && adc_cfg_info[channel].channel_type == HAL_ADC_CHANNEL_TYPE_DIF_BUF) {
- return adc_trans_sytick_to_voltage_diff(stick);
- } else {
- return adc_trans_sytick_to_voltage(stick);
- }
-#else
+
UNUSED(channel);
return adc_trans_sytick_to_voltage_without_auto_scan(stick);
-#endif
}
static bool adc_get_sample_result(float *voltage, uint8_t channel)
uint32_t stick = 0;
uint32_t sample_zero_count = 0;
-#if defined(CONFIG_ADC_SUPPORT_AUTO_SCAN)
- if (uapi_adc_auto_scan_is_enabled()) { return false; }
-#endif /* CONFIG_ADC_SUPPORT_AUTO_SCAN */
-
if (channel >= ADC_CHANNEL_4) {
sample_number = HAL_ADC_SAMPLE_NUMBER_CONFIG_1;
discard_number = HAL_ADC_DISCARD_NUMBER_CONFIG_1;
}
adc_set_sample_stick(stick);
- *voltage = adc_stick_transfer_voltage((uint16_t)stick, channel);
+ *voltage = adc_trans_sytick_to_voltage_without_auto_scan(stick);
UNUSED(discard_number);
return true;
return false;
}
-
-
-#if defined(CONFIG_ADC_SUPPORT_AUTO_SCAN)
-static bool g_adc_scan_continue = false;
-static void adc_callback(uint8_t ch, uint32_t *buffer, uint32_t length, bool *next)
-{
- osal_printk("[IRQ]channel: %d, buffer:0x%x, len: %d. \r\n", ch, buffer, length);
- uint64_t data = 0;
-#if defined(CONFIG_ADC_SUPPORT_LONG_SAMPLE)
- osal_printk("sample data head: %d %d %d %d\r\n", buffer[0], buffer[TEST_PARAM_ARGC_1],
- buffer[TEST_PARAM_ARGC_2], buffer[TEST_PARAM_ARGC_3]);
- osal_printk("sample data tail: %d %d %d %d\r\n", buffer[length - TEST_PARAM_ARGC_4],
- buffer[length - TEST_PARAM_ARGC_3], buffer[length - TEST_PARAM_ARGC_2], buffer[length - TEST_PARAM_ARGC_1]);
-#else
- for (uint32_t i = 0; i < length; i++) {
- osal_printk("[%d]data: %d\r\n", i, buffer[i]);
- data += buffer[i];
- }
-
- if (length != 0) {
- data = data / length;
- }
- osal_printk("average data: %d\r\n", (uint32_t)data);
-#endif
- *next = g_adc_scan_continue;
- UNUSED(ch);
- UNUSED(buffer);
- UNUSED(length);
- UNUSED(next);
-}
-
-static int adc_stop_auto_scan(int argc, char *argv[])
-{
- adc_channel_t channel;
- if (argc != 1) { /* 1: Indicates the number of input parameters */
- return SUITE_ERROR_BAD_PARAMS;
- }
- channel = (adc_channel_t)strtol(argv[0], NULL, 0);
- if (uapi_adc_auto_scan_ch_disable((uint8_t)channel) == ERRCODE_SUCC) {
- return SUITE_OK;
- } else {
- return SUITE_TEST_FAILED;
- }
-}
-
-static int adc_start_auto_scan(int argc, char *argv[])
-{
- pin_t pin;
- pin_mode_t mode;
-#if defined(CONFIG_ADC_SUPPORT_LONG_SAMPLE)
- if (argc != 7) { /* 7: Indicates the number of input parameters */
- return SUITE_ERROR_BAD_PARAMS;
- }
-#else
- if (argc != 6) { /* 6: Indicates the number of input parameters */
- return SUITE_ERROR_BAD_PARAMS;
- }
-#endif
- adc_channel_t channel;
- channel = (adc_channel_t)strtol(argv[0], NULL, 0);
- g_adc_scan_continue = (bool)strtol(argv[TEST_PARAM_ARGC_1], NULL, 0);
- pin = (pin_t)strtol(argv[TEST_PARAM_ARGC_2], NULL, 0);
- mode = (pin_mode_t)strtol(argv[TEST_PARAM_ARGC_3], NULL, 0);
- adc_scan_config_t config = {
- .type = (uint8_t)strtol(argv[TEST_PARAM_ARGC_4], NULL, 0),
- .threshold_l = 0.5, /* 0.5: Threshold scan volatage(v) lower limit. */
- .threshold_h = 1.5, /* 1.5: Threshold scan volatage(v) upper limit. */
- .freq = (uint8_t)strtol(argv[TEST_PARAM_ARGC_5], NULL, 0),
-#if defined(CONFIG_ADC_SUPPORT_LONG_SAMPLE)
- .long_sample_time = (uint32_t)strtol(argv[TEST_PARAM_ARGC_6], NULL, 0),
-#endif
- };
- osal_printk("chan: %d, freq: %d\r\n", channel, config.freq);
-#if defined(CONFIG_ADC_SUPPORT_LONG_SAMPLE)
- osal_printk("long_sample_time = %d\n", config.long_sample_time);
-#endif
-
- uapi_pin_set_mode(pin, mode);
- uapi_adc_power_en(AFE_SCAN_MODE_MAX_NUM, true);
- if (uapi_adc_auto_scan_ch_enable((uint8_t)channel, config, adc_callback) == ERRCODE_SUCC) {
- return SUITE_OK;
- } else {
- return SUITE_TEST_FAILED;
- }
-}
-#endif /* CONFIG_ADC_SUPPORT_AUTO_SCAN */
-#endif /* CONFIG_ADC_SUPPORT_AFE */
bool battery_get_voltage_by_channel(float *voltage, uint8_t channel)
{
-
-#if defined(CONFIG_ADC_SUPPORT_AFE)
- // uapi_suite_add_function("gadc_open_test", "GAFE init & enable test <Sample end: 0~7>", gadc_open_test);
- // uapi_suite_add_function("hadc_open_test", "HAFE init & enable test <Cali enable>", hadc_open_test);
- // uapi_suite_add_function("auto_sample_test", "AFE auto sample test Params: <Sample end: GAFE:0~7 HAFE:8>",
- // adc_auto_sample_test);
- // uapi_suite_add_function("hadc_power_off", "HAFE low power test, power off hafe", hadc_power_off);
- // uapi_suite_add_function("hadc_power_on", "HAFE low power test, power on hafe ", hadc_power_on);
-#else
uapi_adc_init(ADC_CLOCK_500KHZ);
- // uapi_adc_power_en(AFE_SCAN_MODE_MAX_NUM, true);
- // uapi_suite_add_function("adc_manual_test", "Params: <Channel>, <sample_times>, <discard_times>,"
- // "<pin number>, <pin mode>", adc_manual_test);
- // adc_channel_t channel;
-
uint64_t time1, time2;
uint32_t param_index = 0;
- // channel = (adc_channel_t)strtol(argv[param_index++], NULL, 0);
- // g_adc_sample_times = (uint32_t)strtol(argv[param_index++], NULL, 0);
- // g_adc_sample_discard = (uint32_t)strtol(argv[param_index++], NULL, 0);
- // pin = (pin_t)strtol(argv[param_index++], NULL, 0);
- // mode = (pin_mode_t)strtol(argv[param_index++], NULL, 0);
- osal_printk("channel: %d, sample times: %d, discard: %d.\r\n", channel, g_adc_sample_times, g_adc_sample_discard);
-
- // uapi_pin_set_mode(pin, mode);
-#if defined(CONFIG_ADC_SUPPORT_AUTO_SCAN)
- uapi_adc_auto_scan_disable();
-#endif /* CONFIG_ADC_SUPPORT_AUTO_SCAN */
- // osal_printk("PINMUX SET DONE\r\n");
-
+ osal_printk("channel: %d\r\n", channel);
time1 = uapi_tcxo_get_us();
-
if (!adc_get_voltage_by_channel(voltage, channel)) {
osal_printk("adc get sample result failed.\r\n");
return SUITE_TEST_FAILED;
}
time2 = uapi_tcxo_get_us();
-
osal_printk("tick: %d, Sample time: %d. \r\n", adc_get_sample_stick(),
(uint64_t)(time2 - time1));
osal_printk("voltage: %.4f.\r\n", voltage);
-
-#if defined(CONFIG_ADC_SUPPORT_AUTO_SCAN)
- // uapi_suite_add_function("adc_start_auto_scan", "Params: <Channel>, <scan mode:0|1 >, <freq>, <bool: continue>,"
- // "<pin number>, <pin mode>", adc_start_auto_scan);
- // uapi_suite_add_function("adc_stop_auto_scan", "Params: <Channel>", adc_stop_auto_scan);
-#endif /* CONFIG_ADC_SUPPORT_AUTO_SCAN */
-#endif /* CONFIG_ADC_SUPPORT_AFE */
return true;
}
+
+
+uint8_t battery_get_voltage(float *voltage)
+{
+ battery_get_voltage_by_channel(voltage,2);
+ uint8_t percent = 0;
+
+ if (*voltage <= BATTERY_VOLTAGE_MIN)
+ return 0;
+ if (*voltage >= BATTERY_VOLTAGE_MAX)
+ return 100;
+ percent = (*voltage - BATTERY_VOLTAGE_MIN)*100/(BATTERY_VOLTAGE_MAX - BATTERY_VOLTAGE_MIN) ;
+ return percent;
+}
\ No newline at end of file
projects / mirrors / FD230.git / commitdiff