CAPSLOCKX 2022-05-16 03:07 采纳率: 100%
浏览 92
已结题

下面这段代码是dsp控制永磁同步电机中的PID控制,能否详细讲解一下里面的代码含义

        Speed_Error=Speed_Ref - Speed_Fdb;

        Speed_Up=_IQmpy(Speed_Kp,Speed_Error);
        Speed_Ui=Speed_Ui + _IQmpy(Speed_Ki,Speed_Up) + _IQmpy(Speed_Ki,Speed_SatError);

        Speed_OutPreSat=Speed_Up+Speed_Ui;

        if(Speed_OutPreSat>Speed_OutMax)
            Speed_Out=Speed_OutMax;
        else if(Speed_OutPreSat<Speed_OutMin)
             Speed_Out=Speed_OutMin;
        else 
            Speed_Out=Speed_OutPreSat;  

        Speed_SatError=Speed_Out-Speed_OutPreSat;  

        IQ_Given=Speed_Out; 
        Speed_run=1;
    } 
    else 
    {
         SpeedLoopCount++;
    }
    if(Speed_run==1)
    {
    ialfa=ia;
    ibeta=_IQmpy(ia,_IQ(0.57735026918963))+_IQmpy(ib,_IQ(1.15470053837926));  
    //0.577=
    id = _IQmpy(ialfa,Cosine) +_IQmpy(ibeta,Sine);
    iq = _IQmpy(ibeta,Cosine)- _IQmpy(ialfa,Sine) ;



    IQ_Error=IQ_Ref-IQ_Fdb;

    IQ_Up=_IQmpy(IQ_Kp,IQ_Error);
    IQ_Ui=IQ_Ui + _IQmpy(IQ_Ki,IQ_Up) + _IQmpy(IQ_Ki,IQ_SatError);

    IQ_OutPreSat=IQ_Up+IQ_Ui;

    if(IQ_OutPreSat>IQ_OutMax)
        IQ_Out=IQ_OutMax;
    else if(IQ_OutPreSat<IQ_OutMin)
         IQ_Out=IQ_OutMin;
    else 
        IQ_Out=IQ_OutPreSat;  

    IQ_SatError=IQ_Out-IQ_OutPreSat;
    Uq=IQ_Out;


    ID_Error=ID_Ref-ID_Fdb;

    ID_Up=_IQmpy(ID_Kp,ID_Error);    
    ID_Ui=ID_Ui+_IQmpy(ID_Ki,ID_Up)+_IQmpy(ID_Ki,ID_SatError);   

    ID_OutPreSat=ID_Up+ID_Ui;    

    if(ID_OutPreSat>ID_OutMax)   
        ID_Out=ID_OutMax;
    else if(ID_OutPreSat<ID_OutMin)
         ID_Out=ID_OutMin;
    else 
        ID_Out=ID_OutPreSat;  

    ID_SatError=ID_Out-ID_OutPreSat;     
    Ud=ID_Out;

展开全部

  • 写回答

2条回答 默认 最新

  • soar3033 2022-05-17 12:50
    关注
    
    
    Speed_Error = Speed_Ref - Speed_Fdb;  //计算设定速度和反馈速度的差值
    
    Speed_Up = _IQmpy(Speed_Kp, Speed_Error);//IQmpy是IQ lib里的乘法运算,这一步用来计算速度环比例增益和误差的乘积,即PID比例环节的结果
    Speed_Ui = Speed_Ui + _IQmpy(Speed_Ki, Speed_Up) + _IQmpy(Speed_Ki, Speed_SatError);//这一步则计算积分环节的结果
    
    Speed_OutPreSat = Speed_Up + Speed_Ui;//将比例环节和积分环节相加,获得PID的输出
    
    if (Speed_OutPreSat > Speed_OutMax)//限幅判断,如果Speed_OutPreSat大于幅值,则Speed_Out=幅值,即Speed_OutMax
    Speed_Out = Speed_OutMax;
    else if (Speed_OutPreSat < Speed_OutMin)//限幅判断,如果Speed_OutPreSat小于幅值,则Speed_Out=幅值,即Speed_OutMin
        Speed_Out = Speed_OutMin;
    else//如果没有超过两侧的幅度,则Speed_Out = Speed_OutPreSat
    Speed_Out = Speed_OutPreSat;
    
    Speed_SatError = Speed_Out - Speed_OutPreSat;//更新Speed_SatError以用于下一周期的积分计算
    
    IQ_Given = Speed_Out;//将速度环的输出值设定为电机Q轴电流目标值
    Speed_run = 1;//Speed_run是一个运行标志,当其非0时进行电流环计算
        }
        else
        {
        SpeedLoopCount++;//速度环计数
        }
        if (Speed_run == 1)//Speed_run是一个运行标志,当其非0时进行电流环计算
        {
            //Clark变换,把ABC三相电流转换为 α β两相电流
            ialfa = ia;
            ibeta = _IQmpy(ia, _IQ(0.57735026918963)) + _IQmpy(ib, _IQ(1.15470053837926));
            //Park变换,把α β两相电流变为dq轴电流
            id = _IQmpy(ialfa, Cosine) + _IQmpy(ibeta, Sine);
            iq = _IQmpy(ibeta, Cosine) - _IQmpy(ialfa, Sine);
    
    
    
            IQ_Error = IQ_Ref - IQ_Fdb;//计算Q轴电流误差
    
            IQ_Up = _IQmpy(IQ_Kp, IQ_Error);//电流环Q轴PID比例环节
            IQ_Ui = IQ_Ui + _IQmpy(IQ_Ki, IQ_Up) + _IQmpy(IQ_Ki, IQ_SatError);//电流环Q轴PID积分环节
    
            IQ_OutPreSat = IQ_Up + IQ_Ui;//电流环Q轴输出
    
            if (IQ_OutPreSat > IQ_OutMax)//电流环Q轴限幅判断,道理同速度环限幅
                IQ_Out = IQ_OutMax;
            else if (IQ_OutPreSat < IQ_OutMin)
                IQ_Out = IQ_OutMin;
            else
                IQ_Out = IQ_OutPreSat;
    
            IQ_SatError = IQ_Out - IQ_OutPreSat;//更新IQ_SatError以用于下一轮电流环积分环节计算
            Uq = IQ_Out;//更新要输出的q轴电压
    
    
            ID_Error = ID_Ref - ID_Fdb;//计算d轴电流误差
    
            ID_Up = _IQmpy(ID_Kp, ID_Error);//电流环d轴PID比例环节
            ID_Ui = ID_Ui + _IQmpy(ID_Ki, ID_Up) + _IQmpy(ID_Ki, ID_SatError);//电流环d轴PID积分环节
    
            ID_OutPreSat = ID_Up + ID_Ui;////电流环d轴PID输出
    
            if (ID_OutPreSat > ID_OutMax)//限幅判断
                ID_Out = ID_OutMax;
            else if (ID_OutPreSat < ID_OutMin)
                ID_Out = ID_OutMin;
            else
                ID_Out = ID_OutPreSat;
    
            ID_SatError = ID_Out - ID_OutPreSat;
            Ud = ID_Out;
    

    展开全部

    本回答被题主选为最佳回答 , 对您是否有帮助呢?
    评论
    dingruxin 2024-03-10 11:04

    你好,请问你知道该如何把这段闭环控制的代码改成开环控制吗

    回复
    soar3033 回复 dingruxin 2024-03-10 12:06

    你要开环,直接电压给定,然后电角度根据你的时间给定变化就行了,是没有电流环的。

    回复
查看更多回答(1条)
编辑
预览

报告相同问题?

问题事件

  • 系统已结题 5月25日
  • 已采纳回答 5月18日
  • 创建了问题 5月16日

悬赏问题

  • ¥15 为什么投影机用酷喵播放电影放一段时间就播放不下去了?提示发生未知故障,有什么解决办法吗?
  • ¥15 来个会搭建付费网站的有偿
  • ¥100 有能够实现人机模式的c/c++代码,有图片背景等,能够直接进行游戏
  • ¥20 校园网认证openwrt插件
  • ¥15 以AT89C51单片机芯片为核心来制作一个简易计算器,外部由4*4矩阵键盘和一个LCD1602字符型液晶显示屏构成,内部由一块AT89C51单片机构成,通过软件编程可实现简单加减乘除。
  • ¥15 求GCMS辅导数据分析
  • ¥30 SD中的一段Unet下采样代码其中的resnet是谁跟谁进行残差连接
  • ¥15 Unet采样阶段的res_samples问题
  • ¥15 Open GL ES 的使用
  • ¥15 我如果只想表示节点的结构信息,使用GCN方法不进行训练可以吗
手机看
程序员都在用的中文IT技术交流社区

程序员都在用的中文IT技术交流社区

专业的中文 IT 技术社区,与千万技术人共成长

专业的中文 IT 技术社区,与千万技术人共成长

关注【CSDN】视频号,行业资讯、技术分享精彩不断,直播好礼送不停!

关注【CSDN】视频号,行业资讯、技术分享精彩不断,直播好礼送不停!

客服 返回
顶部