手写最简单的simplefoc的svpwm算法（便于理解）

于 2021-12-10 21:59:03 发布
阅读量1.6k 收藏 4
点赞数 1
分类专栏： arduino c++ 文章标签： arduino simplefoc svpwm
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/qqliuzhitong/article/details/121865712
版权
arduino 同时被 2 个专栏收录
69 篇文章 22 订阅
订阅专栏
c++
6 篇文章 0 订阅
订阅专栏
该博客探讨了如何通过改进原始Arduino代码，利用ESP32的MCPWM控制器来替代delay函数，从而提高电机控制中PWM波形的精度。博主详细介绍了代码的修改过程，旨在实现更精确的电机速度控制，并分享了相关代码片段。
摘要由CSDN通过智能技术生成

此帖子用于记录学习过程中写的程序（半成品）。

1.arduino代码：

test.ino

//      (010)U2   II   U6(110)
//             *********
//      III   * *     * *   I
//           *   *   *   *
//  (011)U3 ***************  U4(100)
//           *   *   *   *
//       IV   * *     * *   VI
//             *********
//      (001)U1    V     U5(101)
//author:liuzhitong
//mail:953598974@qq.com

#include "svpwm.h"
#include <SimpleFOC.h>

#define sl 500
#define pi 3.1415926
#define f 30

Motor motor1;

MagneticSensorI2C sensor = MagneticSensorI2C(AS5600_I2C);
TwoWire I2Cone = TwoWire(0);
long t;

void setup() {
  Serial.begin(115200);
  motor1.init();
  I2Cone.begin(18, 5, 400000); 
  sensor.init(&I2Cone);
  t=millis();
}


void loop() {
  //if((motor1.angle_c!=motor1.angle_go)&&((millis()-motor1.old_time)>1))
  if((millis()-motor1.old_time)>25)
  {
    motor1.calculate();
  }
  if((millis()-t)>200)
  {
    sensor.update();
    Serial.println(sensor.getVelocity()); 
    t=millis();
  }
  motor1.svpwm(); 
  
}

svpwm.cpp

#define sqrt_3 1.7320
#define pi 3.1415926
#define T 200

#define enable_pinA 33
#define enable_pinB 32
#define enable_pinC 23

#define piA 25
#define piB 19
#define piC 22

class Motor{
  public:
    double angle_c=0.0;//默认开头是0度,电机角度在U4处
    double velocity_m=10.0;
    long angle_go=41400;//目标角度
    int T0=0,T1=0,T2=0,T7=0;
    int sector;//sector为扇区
    float U_dc=12.0,U_ref=6.0;
    float oumiga=pi;
    int cal_flag=1;//计算扇区和T0,T1,T2,T7的标志位，需要计算时为1，不需要计算时为0
    long old_time=0;//用于判断速度
    
    void init();
    void calculate();
    void svpwm();
};
//计算标志位的函数
void Motor::init()
{
  pinMode(22,OUTPUT);
  digitalWrite(22,HIGH);
  pinMode(32,OUTPUT);
  pinMode(33,OUTPUT);
  pinMode(25,OUTPUT);
  //默认开启的时候在第一区间
  digitalWrite(32,1);
  digitalWrite(33,0);
  digitalWrite(25,0);
  delay(1000);
  old_time=millis();
}
//T=1ms=1us;
//计算标志位的函数
void Motor::calculate()
{
  int angleInSector=int(angle_c)%60;
  sector=(int(angle_c)%360)/60+1;
  T1=sqrt_3*U_ref/U_dc*T*sin(pi*(60-angleInSector)/180);
  T2=sqrt_3*U_ref/U_dc*T*sin(pi*angleInSector/180);
  T0=(T-T1-T2)/2;
  T7=T0;
//  if(angle_c<angle_go)
//  {
    velocity_m=396.0*oumiga/(10.0*pi);
    angle_c=angle_c+2.5*velocity_m;
//  }
  old_time=millis();
//  Serial.println("-");
//  Serial.println(angle_c);
//  Serial.println(sector);
//  Serial.println(T0);
//  Serial.println(T1);
//  Serial.println(T2);
//  Serial.println(T7);
}

void Motor::svpwm()
{
  switch(sector)
  {
    case 1:
    {
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T0/2);
      digitalWrite(32,1);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T1/2);
      digitalWrite(32,1);
      digitalWrite(33,1);
      digitalWrite(25,0);
      delayMicroseconds(T2/2);
      digitalWrite(32,1);
      digitalWrite(33,1);
      digitalWrite(25,1);
      delayMicroseconds(T7);
      digitalWrite(32,1);
      digitalWrite(33,1);
      digitalWrite(25,0);
      delayMicroseconds(T2/2);
      digitalWrite(32,1);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T1/2);
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T0/2);
      break;
    }
    case 2:
    {
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T0/2);
      digitalWrite(32,1);
      digitalWrite(33,1);
      digitalWrite(25,0);
      delayMicroseconds(T1/2);
      digitalWrite(32,0);
      digitalWrite(33,1);
      digitalWrite(25,0);
      delayMicroseconds(T2/2);
      digitalWrite(32,1);
      digitalWrite(33,1);
      digitalWrite(25,1);
      delayMicroseconds(T7);
      digitalWrite(32,0);
      digitalWrite(33,1);
      digitalWrite(25,0);
      delayMicroseconds(T2/2);
      digitalWrite(32,1);
      digitalWrite(33,1);
      digitalWrite(25,0);
      delayMicroseconds(T1/2);
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T0/2);
      break;
    }
    case 3:
    {
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T0/2);
      digitalWrite(32,0);
      digitalWrite(33,1);
      digitalWrite(25,0);
      delayMicroseconds(T1/2);
      digitalWrite(32,0);
      digitalWrite(33,1);
      digitalWrite(25,1);
      delayMicroseconds(T2/2);
      digitalWrite(32,1);
      digitalWrite(33,1);
      digitalWrite(25,1);
      delayMicroseconds(T7);
      digitalWrite(32,0);
      digitalWrite(33,1);
      digitalWrite(25,1);
      delayMicroseconds(T2/2);
      digitalWrite(32,0);
      digitalWrite(33,1);
      digitalWrite(25,0);
      delayMicroseconds(T1/2);
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T0/2);
      break;
    }
    case 4:
    {
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T0/2);
      digitalWrite(32,0);
      digitalWrite(33,1);
      digitalWrite(25,1);
      delayMicroseconds(T1/2);
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,1);
      delayMicroseconds(T2/2);
      digitalWrite(32,1);
      digitalWrite(33,1);
      digitalWrite(25,1);
      delayMicroseconds(T7);
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,1);
      delayMicroseconds(T2/2);
      digitalWrite(32,0);
      digitalWrite(33,1);
      digitalWrite(25,1);
      delayMicroseconds(T1/2);
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T0/2);
      break;
    }
    case 5:
    {
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T0/2);
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,1);
      delayMicroseconds(T1/2);
      digitalWrite(32,1);
      digitalWrite(33,0);
      digitalWrite(25,1);
      delayMicroseconds(T2/2);
      digitalWrite(32,1);
      digitalWrite(33,1);
      digitalWrite(25,1);
      delayMicroseconds(T7);
      digitalWrite(32,1);
      digitalWrite(33,0);
      digitalWrite(25,1);
      delayMicroseconds(T2/2);
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,1);
      delayMicroseconds(T1/2);
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T0/2);
      break;
    }
    case 6:
    {
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T0/2);
      digitalWrite(32,1);
      digitalWrite(33,0);
      digitalWrite(25,1);
      delayMicroseconds(T1/2);
      digitalWrite(32,1);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T2/2);
      digitalWrite(32,1);
      digitalWrite(33,1);
      digitalWrite(25,1);
      delayMicroseconds(T7);
      digitalWrite(32,1);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T2/2);
      digitalWrite(32,1);
      digitalWrite(33,0);
      digitalWrite(25,1);
      delayMicroseconds(T1/2);
      digitalWrite(32,0);
      digitalWrite(33,0);
      digitalWrite(25,0);
      delayMicroseconds(T0/2);
      break;
    }
  }
}

2.改进一下

我们上面直接用delay生成的pwm波，这样精确性很差，这里我们使用esp32的mcpwm控制器来产生pwm波。

Allen953
关注
  • 1
    点赞
  • 踩
  • 4
    收藏
    觉得还不错? 一键收藏
  • 打赏
    打赏
  • 1
    评论
专栏目录
评论 1
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

打赏作者

Allen953

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

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

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

打赏作者

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

抵扣说明：

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

余额充值