阳极PID

发布时间 2023-05-26 05:30:00作者: dage0709

/* 阳极状态:
* 1. 0.8 ->boost;
* 2. 1.3 ->run;
* 3. 1.8 ->brake;
* 4. 0V ->idle.
0.6->1->1.4
*/

TIM1 0.1ms进入一次中断

RotorMainCur_Buf =ADC2->DR;                 //ADC2 IN14
RotorMainCur_dot1ms +=RotorMainCur_Buf;     //0.1ms累计

RotorMainCur_1ms =RotorMainCur_dot1ms/10;   //1ms将累计10次的值求平均值
RotorMainCur_dot1ms =0;                     //1ms累计值清零

对反馈值消抖,输出:RotorMainCur_1ms

TIM2 1ms 进入一次中断

RotorMainCur_10ms +=RotorMainCur_1ms;       //1ms累计
rotor_10ms_temp =RotorMainCur_10ms / 10;    //10ms累计10次的值求平均值

RotorStandbyCur_Ain = rotor_10ms_temp;
    if(RotorStandbyCur_Ain > MAX_ROTOR_RUN_CUR) 
        连续10000ms报:阳极静态电流高 999
        Precharge信号关闭,停止阳极供电

RotorMainCur_Ain    = rotor_10ms_temp;
    if(RotorMainCur_Ain < MIN_ROTOR_MAIN_CUR) //90  0.6A
        连续500ms报:主绕组欠电流
    if(RotorMainCur_Ain > MAX_ROTOR_RUN_CUR)  //680
        连续500ms报:阳极主绕组电流高 998