打印
[电机控制]

foc闭环调试_pi控制器调试程序框架

[复制链接]
344|12
手机看帖
扫描二维码
随时随地手机跟帖
跳转到指定楼层
楼主
OKAKAKO|  楼主 | 2024-9-29 16:17 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
1、ADC电流偏置读取

void Offset_CurrentReading(void) 
{
       static uint16_t ADC_PhaseU_Curr[100];
       static uint16_t ADC_PhaseV_Curr[100];
       uint16_t temp;
       uint32_t sum_U=0;
       uint32_t sum_V=0;
       uint8_t i,k;

       for(i=0;i<100;i++){
              while(DMA_GetFlagStatus(DMA2_Stream0,DMA_FLAG_TCIF0)==RESET);  
               DMA_ClearFlag(DMA2_Stream0,DMA_FLAG_TCIF0);        
                  ADC_PhaseU_Curr[i] = ADC_DualConvertedValueTab[0];
                 ADC_PhaseV_Curr[i] = ADC_DualConvertedValueTab[1];
       }

       for(k=0;k<100;k++){
           for(i=k+1;i<100;i++)   
               if(ADC_PhaseU_Curr[i]>ADC_PhaseU_Curr[k]){
                    temp=ADC_PhaseU_Curr[i];
                    ADC_PhaseU_Curr[i]=ADC_PhaseU_Curr[k];
                    ADC_PhaseU_Curr[k]=temp;
                }
           }
              sum_U=0;

       for(k=25;k<75;k++){
           sum_U=sum_U+ADC_PhaseU_Curr[k];
       }
       ADCSampPare.OffsetPhaseU_Curr =sum_U/50;      
       printf("U: %d \n", ADCSampPare.OffsetPhaseU_Curr);      

       for(k=0;k<100;k++){
           for(i=k+1;i<100;i++)
                if(ADC_PhaseV_Curr[i]>ADC_PhaseV_Curr[k]){
                     temp=ADC_PhaseV_Curr[i];
                     ADC_PhaseV_Curr[i]=ADC_PhaseV_Curr[k];
                     ADC_PhaseV_Curr[k]=temp;
                }   
       }
       sum_V=0;
       for(k=25;k<75;k++){
           sum_V=sum_V+ADC_PhaseV_Curr[k];
       }
       ADCSampPare.OffsetPhaseV_Curr =sum_V/50;      
       printf("V: %d \n", ADCSampPare.OffsetPhaseV_Curr);      
}


2、转速测量

为以后速度环做准备

       angeel_ch[sp_flag]=Anglee;             
       if ((TIM2->CR1 & TIM_CounterMode_Down) == TIM_CounterMode_Down){
       //encoder timer down-counting
              if(angeel_ch[sp_flag]>angeel_ch[(sp_flag+1)%11])      
              interval=angeel_ch[sp_flag]-angeel_ch[(sp_flag+1)%11]-4000;
              else interval=angeel_ch[sp_flag]-angeel_ch[(sp_flag+1)%11];
       }
       else{            
              if(angeel_ch[sp_flag]<angeel_ch[(sp_flag+1)%11])</angeel_ch[(sp_flag+1)%11])
              interval=angeel_ch[sp_flag]-angeel_ch[(sp_flag+1)%11]+4000;
              else interval=angeel_ch[sp_flag]-angeel_ch[(sp_flag+1)%11];
       }

       if((interval<200)&&(interval>-200)){      
              speedms=interval*15;
              FirstOrder_LPF_Cacl(speedms,speedms_F,0.1);
              pi_spd.Fdb=speedms_F;
       }

       sp_flag++;
       if (sp_flag>=11)sp_flag=0;  





3、q轴单轴调试

      Pid参数:

#define  Id_Kp                      0.0
#define  Id_Ki                      0.0
#define  Id_Kc                      0

#define  Iq_Kp                      0.1
#define  Iq_Ki                      0.5
#define  Iq_Kc                      0

pi_iq.Ref= 50;         
pi_iq.Fdb=I_dq.I2;
PID_CALC(pi_iq);
FirstOrder_LPF_Cacl(pi_iq.Out,pi_iq.OutF,0.05);
Volt_dq.V2= pi_iq.OutF;
Volt_dq.V1= 0;

结合之前的开环调试,整体流程大致这样。



4、PID限幅与计算

#define UP16LIMIT(var,max,min) {(var) = (var)>(max)?(max):(var) ;

#define PID_CALC(v)               \
v.Err = v.Ref - v.Fdb;            \
v.Up= _IQmpy(v.Kp,v.Err);         \
v.Ui= v.Ui + _IQmpy(v.Ki,v.Up);   \
UP16LIMIT(v.Ui,v.OutMax,v.OutMin);\
v.Ud = v.Kd * (v.Up - v.Up1);\
v.Out = v.Up + v.Ui + v.Ud;\
UP16LIMIT(v.Out,v.OutMax,v.OutMin);\   
v.Up1 = v.Up;  




5、主程序调用



int main(void)
{
  NVIC_Configuration();

  StateContr.Control_Mode = 1;

  PID_init();
  Key_GPIO();

  Hall_Gpio();
  Encoder_Init();
  USARTx_Config();

  Adc_Conf();

  DRV8313_GPIO();
  Tim1_PWM_Init();

  ROTATOR_Init();  
  printf("hello \n");
  Offset_CurrentReading();

  while(1){   
    Key_Scan();   
  }
}


使用特权

评论回复
沙发
小小蚂蚁举千斤| | 2024-9-29 18:56 | 只看该作者
PID重在调节参数

使用特权

评论回复
板凳
AdaMaYun| | 2024-9-30 11:23 | 只看该作者
研究一下参数代码

使用特权

评论回复
地板
为你转身| | 2024-9-30 12:54 | 只看该作者
ADC_PhaseV_Curr[i]=ADC_PhaseV_Curr[k];                      ADC_PhaseV_Curr[k]=temp;

使用特权

评论回复
5
tpgf| | 2024-10-11 09:24 | 只看该作者
FOC系统通常采用双闭环架构,包括内部的电流环和外部的速度环或位置环

使用特权

评论回复
6
木木guainv| | 2024-10-11 18:11 | 只看该作者
通过PI控制器处理Iq和Id,实现对交流同步电机的控制

使用特权

评论回复
7
磨砂| | 2024-10-11 18:43 | 只看该作者
通过PI控制器处理Iq和Id,实现对交流同步电机的控制

使用特权

评论回复
8
晓伍| | 2024-10-11 19:14 | 只看该作者
电机机械角度和电角度对准后进入电流闭环,给定iq目标值,观察Iq和Id的变化

使用特权

评论回复
9
八层楼| | 2024-10-11 19:47 | 只看该作者
传统的PI控制器可能需要结合优化算法以提升性能

使用特权

评论回复
10
观海| | 2024-10-11 20:20 | 只看该作者
传统的PI控制器可能需要结合优化算法以提升性能

使用特权

评论回复
11
Amazingxixixi| | 2024-10-30 15:43 | 只看该作者
PID是软件的么?还是硬件的?

使用特权

评论回复
12
地瓜patch| | 2024-10-31 08:15 | 只看该作者
电机控制必不可少的基本方法

使用特权

评论回复
13
suncat0504| | 2024-10-31 10:34 | 只看该作者
pid控制器调试程序,学习

使用特权

评论回复
发新帖 我要提问
您需要登录后才可以回帖 登录 | 注册

本版积分规则

209

主题

1446

帖子

4

粉丝