voltagesense.cpp

Go to the documentation of this file.

/*
 * voltagesense.cpp
 *
 *  Created on: Feb 1, 2020
 *      Author: Yannick
 */
 
#include "global_callbacks.h"
#include "constants.h"
#include "voltagesense.h"
#include "ErrorHandler.h"
#include "AdcHandler.h"
#include "FastAvg.h"
 
bool braking_flag = false;
int32_t maxVoltage = 65000; // Force braking
int32_t voltageDiffActivate = 5000;
int32_t voltageDiffDeactivate = 4000;
float vSenseMult = VOLTAGE_MULT_DEFAULT;
bool brake_failure = false;
int32_t minVoltage = 6500;
 
uint32_t brakeActiveTime = 0;
const Error resError = Error(ErrorCode::brakeResistorFailure, ErrorType::critical, "Brake resistor stuck on");
 
/*
 * Multiplier to convert ADC counts to a sensed voltage on the vInt and vExt pins.
 */
void setVSenseMult(float vSenseMultiplier){
    vSenseMult = vSenseMultiplier;
}
 
/*
 * vMax: maximum voltage where the brake pin goes always high
 * vdiffAct: difference between vInt and vExt to activate brake pin
 * vdiffDeact: difference when to deactivate brake pin again (must be lower than vdiffAct)
 * Set vMax = 0 to completely deactivate the brake resistor function. DANGEROUS
 *
 */
void setupBrakePin(int32_t vdiffAct,int32_t vdiffDeact,int32_t vMax){
    maxVoltage = vMax;
    voltageDiffActivate = vdiffAct;
    voltageDiffDeactivate = vdiffDeact;
}
 
float adcValToVoltage(uint32_t adcval){
    if(ADC_INTREF_VOL == 0){
        return 0; // Divbyzero
    }
    return __LL_ADC_CALC_DATA_TO_VOLTAGE(ADC_INTREF_VOL,adcval,VSENSE_ADC_RES);
}
 
int32_t getIntV(){
    return adcValToVoltage(VSENSE_ADC_BUF[ADC_CHAN_VINT]) * vSenseMult;
 
}
 
int32_t getExtV(){
    return adcValToVoltage(VSENSE_ADC_BUF[ADC_CHAN_VEXT]) * vSenseMult;
}
 
void brakeCheck(){
    if(maxVoltage == 0 || brake_failure){
        return;
    }
    int32_t vint = getIntV();
    int32_t vext = getExtV();
 
    if(vint < minVoltage && vext < minVoltage){
        return; // Do not enable if device is unpowered (just measuring usb leakage)
    }
 
    bool lastBrakingFlag = braking_flag;
    braking_flag = (vint > vext + voltageDiffActivate) || vint > maxVoltage || (braking_flag && (vint > vext + voltageDiffDeactivate));
            //(ADC_BUF[ADC_CHAN_VINT] > ADC_BUF[ADC_CHAN_VEXT]+400 || (ADC_BUF[ADC_CHAN_VINT] > 3000));
    if(braking_flag != lastBrakingFlag){
        if(braking_flag){
            brakeActiveTime = HAL_GetTick();
        }else{
            brakeActiveTime = 0;
        }
    }
    if(brakeActiveTime && HAL_GetTick() - brakeActiveTime > 5000){
        // Brake resistor active over 5s. Shut down.
        brake_failure = true;
        HAL_GPIO_WritePin(DRV_BRAKE_GPIO_Port,DRV_BRAKE_Pin, GPIO_PIN_RESET);
        // can not create error here in ISR
        //ErrorHandler::addError(resError);
    }else{
        HAL_GPIO_WritePin(DRV_BRAKE_GPIO_Port,DRV_BRAKE_Pin, braking_flag ? GPIO_PIN_SET:GPIO_PIN_RESET);
    }
 
}
 
FastMovingAverage<int32_t>chipTempAvg{3};
__weak int32_t getChipTemp(){
#if !defined(TEMPSENSOR_ADC_VAL) || !defined(__LL_ADC_CALC_TEMPERATURE)
    return 0;
#else
    if(!TEMPSENSOR_ADC_VAL || !ADC_INTREF_VOL){
        return 0; // divby0 risk
    }
    return chipTempAvg.addValue(__LL_ADC_CALC_TEMPERATURE(ADC_INTREF_VOL,TEMPSENSOR_ADC_VAL,TEMPSENSOR_ADC_RES));
#endif
 
}