Motor_PMSM/Application/FOC/vbus_sensor.c

#include "vbus_sensor.h"
#include "bsp/bsp.h"

static vbus_t _vbus;
void vbus_sensor_init(void){
	_vbus.voltage_avg = 0;
	_vbus.avg_count = 16;
	HAL_ADC1_ChanConfig(VBUS_SENSOR_ADC_CHANNEL);

}

float vbus_get_voltage(void){
	u32 vadc = 0;
	u32 max = 0, min = 0xFFFFFFF;
	for (int i = 0; i < _vbus.avg_count; i++) {
		u32 one = HAL_ADC1_ReadValue(VBUS_SENSOR_ADC_CHANNEL);
		vadc += one;
		if (min > one) {
			min = one;
		}
		if (max < one) {
			max = one;
		}
	}
	vadc -= (max + min);
	vadc = vadc / (_vbus.avg_count - 2);
	_vbus.voltage_avg = vadc/65536 * ADC_REFERENCE_VOLTAGE / VBUS_PARTITIONING_FACTOR;

	return _vbus.voltage_avg;
}