基于DSP280049C的正点原子PMSM电机驱动（二）：FOC文件的建立与开环代码编写

已于 2023-07-10 20:09:56 修改
阅读量768 收藏 10
点赞数 2
分类专栏： DSP电机驱动系列 文章标签： 单片机 嵌入式硬件 dsp开发
于 2023-07-10 19:38:35 首次发布
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/qq_45854134/article/details/131645863
版权

FOC.h文件的建立

FOC头文件中，主要放入源文件中将会用到的部分参数值，以及电机相关的参数。

/*
 * FOC.h
 *
 *  Created on: 2023年7月10日
 *      Author: 24460
 */

#ifndef USER_INC_FOC_H_
#define USER_INC_FOC_H_

#include "driverlib.h"
#include "device.h"

/*常用数学值*/
#define pi      3.14159                 //pi
#define pi_2    6.28318                 //2*pi
#define pi_180  0.01745                 //2*pi/360
#define sqrt3   1.73205                 //sqrt(3)
#define sqrt3_2 0.86603                 //sqrt(3)/2
#define sqrt23  0.81649                 //sqrt(2/3)
#define sqrt24  0.70710                 //sqrt(2/4)

/*逆变器相关参数*/
#define Udc     24                      //母线电压
#define fsw     5000                    //MOSFET开关频率，也是PWM的周期频率
#define Ts      0.0002                  //MOSFET开关时间，也是PWM的周期时间，200us
#define K       (sqrt3*Ts)/Udc          //SVPWM中间参数
#define K_park  0.6667                  //clark以及park变换为等大小变换

/*PMSM参数*/
#define rpm_rated   3000    //电机额定机械转速
#define Ed          0.0043  //反电动势系数：0.0043v/rpm
#define Pn          8/2     //极对数
#define R           1.02    //定子电阻，单位为Ω
#define L           0.00059  //定子电感
#define Ld          0.00059  //直轴电感0.59mH
#define Lq          0.00059  //交轴电感0.59mH

void Open_FOC_contral(void);

#endif /* USER_INC_FOC_H_ */

FOC.c文件的建立

FOC源文件中主要是FOC控制的计算过程，并且以函数的形式能够被PWM中断周期性的调用。

/*
 * FOC.c
 *
 *  Created on: 2023年7月10日
 *      Author: 24460
 */

#include "F28x_Project.h"
#include "IQmathLib.h"
#include "FOC.h"
#include "PWM.h"

void Open_FOC_contral(void)
{
    //电流参数
    static _iq ia;static _iq ib;static _iq ic;
    static _iq ialpha;static _iq ibeta;
    static _iq id;static _iq iq;
    //电压参数
    static _iq ua;static _iq ub;static _iq uc;
    static _iq ualpha;static _iq ubeta;
    static _iq ud;static _iq uq;
    //磁通参数定义
    static _iq phi_a;static _iq phi_b;static _iq phi_c;
    static _iq phi_alpha;static _iq phi_beta;
    static _iq phi_d;static _iq phi_q;

    //运行状态参数
    static _iq now_Etheta = _IQ(0);              //当前的电角度值
    static _iq now_Mtheta = _IQ(0);              //当前的机械角度值

    //SVPWM相关参数
    static _iq cos_Etheta;              //当前电角度的cos值，用以坐标变换
    static _iq sin_Etheta;              //当前电角度的sin值，用以坐标变换
    _iq u1;_iq u2;_iq u3;               //中间计算变量
    float U1;  float U2;  float U3;                             //SVPWM电压计算的中间变量
    int A;int B;int C;int N;                                    //扇区判断的中间变量
    float T[8];                                                 //各方向向量作业时间
    float Fu;float Fv;float Fw;                                 //uvw上桥臂置高时间
    float Tu;float Tv;float Tw;                                 //Fu,Fv,Fw与Ts的比值
    /*SVPWM相关参数end*/


    /*************************函数程序开始位置*********************************/
    now_Etheta = now_Etheta + _IQmpy( _IQ(5) , _IQ(pi_180) );  //开环控制，角度自增，每周期增加n°
    cos_Etheta = _IQcos(now_Etheta);
    sin_Etheta = _IQsin(now_Etheta);
    ud = _IQ(0);
    uq = _IQ(5);

    ualpha = _IQmpy( ud , cos_Etheta ) - _IQmpy( uq , sin_Etheta ) ;
    ubeta = _IQmpy( uq , cos_Etheta ) + _IQmpy( ud , sin_Etheta ) ;
    u1 = ubeta;
    u2 = _IQmpy( _IQ(sqrt3_2) , ualpha ) - _IQmpy(_IQ(0.5) , ubeta);
    u3 = _IQmpy( _IQ(-sqrt3_2) , ualpha ) - _IQmpy(_IQ(0.5) , ubeta);
    U1 = _IQtoF(u1);U2 = _IQtoF(u2);U3 = _IQtoF(u3);

    if (U1 > 0)  {A=1;} else {A=0;}
    if (U2 > 0)  {B=1;} else {B=0;}
    if (U3 > 0)  {C=1;} else {C=0;}
    N=4*C+2*B+A;

    switch (N){
            case 1://第二扇区
                T[2]=-K*U3;
                T[6]=-K*U2 ;
                if ( T[2]+T[6]>Ts)
                {
                    T[2]=T[2]*Ts/(T[2]+T[6]);
                    T[6]=T[6]*Ts/(T[2]+T[6]);
                }
                T[0]=(Ts-T[2]-T[6])/2;
                T[7]=T[0];
                T[1]=0.0;
                T[3]=0.0;
                T[4]=0.0;
                T[5]=0.0;
                Fu=T[6]+T[7];
                Fv=T[2]+T[6]+T[7];
                Fw=T[7];
                break;
            case 2://第六扇区
                T[4]=-K*U2;
                T[5]=-K*U1 ;
                if ( T[4]+T[5]>Ts)
                {
                    T[4]=T[4]*Ts/(T[4]+T[5]);
                    T[5]=T[5]*Ts/(T[4]+T[5]);
                }
                T[0]=(Ts-T[4]-T[5])/2;
                T[7]=T[0];
                T[2]=0.0   ;
                T[6]=0.0    ;
                T[1]=0.0               ;
                T[3]=0.0;
                Fu=T[4]+T[5]+T[7];
                Fv=T[7];
                Fw=T[5]+T[7];
                break;
            case 3://第一扇区
                T[4]=K*U3;
                T[6]=K*U1 ;
                if ( T[4]+T[6]>Ts)
                {
                    T[4]=T[4]*Ts/(T[4]+T[6]);
                    T[6]=T[6]*Ts/(T[4]+T[6]);
                }
                T[0]=(Ts-T[4]-T[6])/2;
                T[7]=T[0];
                T[1]=0.0;
                T[2]=0.0;
                T[3]=0.0;
                T[5]=0.0;
                Fu=T[4]+T[6]+T[7];
                Fv=T[6]+T[7];
                Fw=T[7];
                break;
            case 4://第四扇区
                T[1]=-K*U1;
                T[3]=-K*U3 ;
                if ( T[1]+T[3]>Ts)
                {
                    T[1]=T[1]*Ts/(T[1]+T[3]);
                    T[3]=T[3]*Ts/(T[1]+T[3]);
                }
                T[0]=(Ts-T[1]-T[3])/2;
                T[7]=T[0];
                T[2]=0.0   ;
                T[6]=0.0    ;
                T[4]=0.0               ;
                T[5]=0.0;
                Fu=T[7];
                Fv=T[3]+T[7];
                Fw=T[1]+T[3]+T[7];
                break;
            case 5://第三扇区
                T[2]=K*U1;
                T[3]=K*U2;
                if ( T[2]+T[3]>Ts)
                {
                    T[2]=T[2]*Ts/(T[2]+T[3]);
                    T[3]=T[3]*Ts/(T[2]+T[3]);
                }
                T[0]=(Ts-T[2]-T[3])/2;
                T[7]=T[0];
                T[1]=0.0;
                T[6]=0.0;
                T[4]=0.0;
                T[5]=0.0;
                Fu=T[7];
                Fv=T[2]+T[3]+T[7];
                Fw=T[3]+T[7];
                break;
            case 6://第五扇区
                T[1]=K*U2;
                T[5]=K*U3 ;
                if ( T[1]+T[5]>Ts)
                {
                    T[1]=T[1]*Ts/(T[1]+T[5]);
                    T[5]=T[5]*Ts/(T[1]+T[5]);
                }
                T[0]=(Ts-T[1]-T[5])/2;
                T[7]=T[0];
                T[2]=0.0   ;
                T[6]=0.0    ;
                T[4]=0.0               ;
                T[3]=0.0;
                Fu=T[5]+T[7];
                Fv=T[7];
                Fw=T[1]+T[5]+T[7];
                break;
            default :
                break;
        }
        /*以上为电压矢量及其作用时间计算过程*/
        Tu=Fu/Ts;Tv=Fv/Ts;Tw=Fw/Ts;

}

到此，FOC开环控制的程序逻辑基本上明了了，但是此时仅仅是得到了三相桥上桥臂的占空比，下一步就是要配置PWM，并在每个周期中将占空比代入。

基于DSP280049C的电机驱动系列回顾：

（一）：CCS文件夹的建立与IQmath导入
（二）：FOC文件的建立与开环代码编写

Tony0925
关注
  • 2
    点赞
  • 踩
  • 10
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 0
    评论
专栏目录
PMSM控制_foc 控制环路
D_Mr
03-10 1096
（4）速度环控制，将目标速度和估算的速度做差给到 PI，得出给定 Iq，一般是 10 倍或者 20 倍于电流环的周期执行一次。（2）取上一个周期的 Ualpha、Ubeta 和 Ialpha、Ibeta 进行位置和速度的估算。中间肯定还有其他的计算，比如 SVPWM 的电压矢量的幅值的计算，过流保护，过压欠压保护等的处理。（3）park 变换，将 Ialpha、Ibeta 变换为旋转坐标系下的 Id、Iq。（1）clarke 变换，将电流变换至静止坐标系下的 Ialpha、Ibeta。
FOC专题--什么是开环转？
Anitawen的博客
03-30 3337
经常听说开环调试，你知道什么是开环调试吗？
新手小白的FOC学习之路（代码篇）（一）开环控制
最新发布
weixin_43412430的博客
05-26 906
FOC开环控制
PMSM FOC VF 电压频率开环控制
07-15
转 VF算法控制三相无刷电机，开环控制，无传感器(VF controlled three-phase brushless motor) 包含FOC 核心算 clark park ipark svpwm IQ格式的计算，值得参考。只要设定电压与频率比就能让电机，属于开环控制，很好验证硬件与软件的程序。
电机系列（1） - foc最基本原理、clark变换 、park变换、附代码
nepqiu的博客
03-17 2万+
什么是FOC？ FOC（Field-Oriented Control），直译是磁场定向控制，也被称作矢量控制 （VC，Vector Control） ，是目前无刷直流电机（BLDC）和永磁同步电机（PMSM）高效控制的最优方法之一。FOC旨在通过精确地控制磁场大小与方向，使得电机的运动转矩平稳、噪声小、效率高，并且具有高速的动态响应。 简单来说就是，FOC是一种对无刷电机的驱动控制方法，它可以让我们对无刷电机进行 “像素级” 控制，实现很多传统电机控制方法所无法达到的效果。 因为所谓的“矢量控制”其实就是
【正点原子】STM32电机应用控制学习笔记——2.直流无刷电机基础知识
weixin_65176607的博客
12-26 6073
正点原子stm32电机学习笔记2.直流无刷电机的基础知识，包括无刷电机的驱动原理，驱动板介绍，以及编程实战
【STM32-HAL库】一步步搭建出FOC矢量控制（附C代码）
电气chaochao的博客
11-16 4万+
说明 本文为无刷电机或PMSM电机驱动的简易代码，旨在分享一些个人调试过程的小心得，提供一个demo文件，程序仍有许多不完善的地方，建立起个人的FOC底层驱动，可以帮助快速熟悉FOC算法原理与使用方法，可以帮助验证新的电机控制算法。原理部分不再阐述。 整个部分共有PWM模块、ADC电流采集、定时器编码器配置、SVPWM模块、FOC核心、PID模块、电压限幅模块，其实有了PWM与SVPWM以及一些必要的数学变换，我们就可以开环使电机转起来了，加入电角度与电流采集作为反馈后，我们就能做到电流闭环，再加入速度PI
FOC开环驱动电机（开源小项目==FOC控制BLDC电机）
栋哥修炼日记
04-14 5267
SVPWM算法
FOC算法笔记
musanruqiu的博客
03-28 1319
算法笔记，以结论为主。
FOC笔记整理（变换+SVPWM+PID+磁链圆限制）+数学推导及算法实现
qq_28149763的博客
06-24 3268
文中有部分公式了图片转换失败了，原文是用语雀文档写的，需要的自行下载PDF下载链接或者浏览原文链接： pdf链接： 原文链接：所谓克拉克变换，实际上就是降维解耦的过程，把难以辨明和控制的三相相位差120°电机波形降维为两维矢量。 首先因为由基尔霍夫电流定律（KCL），在任一时刻，流入节点的电流之和等于流出节点的电流之和，也就是说 Ia+Ib+Ic=0I_a+I_b+I_c=0Ia​+Ib​+Ic​=0 由上图三维变换为二维的变换公式： {Iα=k(Ia−Ibsin30°−Icsin30)Iβ=k(Ibs
SimpleFOC移植STM32（二）—— 开环控制
loop222的博客
09-05 3万+
目录说明一、硬件介绍1.1、硬件准备1.1.1、SimpleMotor方案1.1.2、SimpleFOCShield V2.0.3方案1.2、硬件连接1.2.1、原理图1.2.2、接线二、控制原理2.1、SVPWM2.2、极对数2.3、开环控制三、软件操作和程序下载3.1、Keil编译生成hex文件3.2、FlyMcu下载3.3、SimpleMotor准备3.4、串口发送指令四、程序演示4.1、开环速度控制4.2、开环位置控制   说明   学习本节之前，建议先看《SimpleFOC（二）—— 快速入门 （
DSP280049C初学（3）-DSP280049C的ECAP配置，STM32F103C8T6作为信号发生端
qq_45854134的博客
07-03 1747
DSP280049C的ECAP配置，STM32F103C8T6作为信号发生端。
无感FOC基于DSP28335平台的无感FOC算法代码包括了完整的矢量控制算法，在smo的基础上
VIRbgjGDoJ的博客
11-08 1417
无感FOC是由无感传感器实现的矢量控制（Field Oriented Control）算法，它可以大大提高电机控制的精度和效率，从而提高电机的性能和使用寿命。同时，我们还提供了带算法对应的详细论文，其中涵盖了算法的原理和实现细节。同时，该算法还可以通过磁链观测器和位置观测器来实现更加精细的控制，例如电机的自适应控制和故障诊断。代码包括了完整的矢量控制算法，在smo的基础上，增加了VESC原始的磁链观测器，还增加了磁链观测器+PLL方案，还增加了增量编码器的接口代码，方便大家调试无感算法。
[开源]圆形FOC无刷驱动Baize_foc
qqliuzhitong的博客
07-18 1779
自制无刷电机驱动器Baize_foc，测试无刷电机。
ST的FOC库 2.0学习 霍尔矢量控制
Us_Wang的博客
02-03 1万+
ST的FOC库 2.0学习     由于新冠状病毒的缘故，被硬核封村，在家也没事，在网上找到了些ST的FOC代码，看一看，并且写个文档记录一下，可供大家一块看看学习学习。垃圾新手，望大佬多多批评。     因为是老版本的FOC代码，浏览起来简单些，当做了入门代码，我这里只是为了学习一下FOC的代码风格和流程，只是大致浏览代码，很多细节也没有细看。 1.1 霍尔矢量闭环控制     在浏览了ST的有...
AC7811-FOC无感控制代码详解
小胡同学的工程师学习之路
04-13 4387
PMSM 的矢量控制也称为磁场定向控制（Field Oriented Control，FOC） 。在 FOC 中，电机的定子电流被分解为用于产生磁场的直流电流（励磁电流）与用于控制转矩的交轴电流（转矩电流），通过对转速和电流的双环控制实现电机的高性能运行。
大厂成熟Foc电机代码STM32f031C6. 把原先的原理图，给整理了
m0_69372936的博客
04-10 6074
大厂成熟Foc电机代码STM32f031C6. 把原先的原理图，给整理了。 图中可以对比，对电路做了说明。 功能口的备注。 代码部分功能做了说明。 提供脑图文档说明。 文档包括：原理图，pcb，代码，软件运行说明文档。 STM32F0固件包。 硬件功能没有测试，需要测试的朋友可以打板测试。 软件要求，对stm32的IO配置，pwm刹车功能有一定的了解，电机算法可以借鉴，但要知道采样数据是哪里传递的，标志位一类的，不然应用会比较吃力。 硬件要求，知道比较器功能，自举电路的应用。 后期自己更改也方便。 以下功能
FOC和SVPWM的C语言代码实现
热门推荐
qlexcel的专栏
07-09 12万+
SVPWM的原理讲解在这儿：https://blog.csdn.net/qlexcel/article/details/74787619#comments 现在开始分析C语言的代码（代码建议复制到notepad++中查看），为方便读者试验，每个代码都是独立的子模块，复制到工程中就可以编译运行： 一、配置高级定时器TIM1产生6路互补PWM，带刹车保护 详细配置代码如下，把下面的程序段拷贝到m...
TMS320F28335实现PMSM无传感器控制：FOC算法详解与应用
本应用报告深入探讨了如何利用TI公司的C2000系列微控制器TMS320F28335实现无位置传感器的永磁同步电机(PMSM)控制。TMS320F2833x因其强大的浮点处理能力，特别适合于高级数字矢量控制算法，如磁场定向控制(FOC)的实现...
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包

打赏作者

Tony0925

你的鼓励将是我创作的最大动力

¥1 ¥2 ¥4 ¥6 ¥10 ¥20
扫码支付：¥1
获取中
扫码支付

您的余额不足，请更换扫码支付或充值

打赏作者

实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值