24年电赛——自动行驶小车（H题）MSPM0G3507-编码电机驱动与通用PID

于 2024-08-03 22:59:36 发布
阅读量207 收藏 5
点赞数 4
分类专栏： MSPM0G3507 文章标签： 单片机 嵌入式硬件 学习 笔记
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/m0_74800695/article/details/140897932
版权

一、编码电机驱动

        编码电机的详情可以查看此篇文章：

stm32平衡小车--（1）JGB-520减速电机+tb6612（附测试代码）_jgb520-CSDN博客

        简单来说，编码电机的驱动主要是给一个 PWM 和一个正负级就能驱动。PWM 的大小决定转速快慢，电机的两个电源正负极不同决定了旋转的方向不同。

1、PWM设置：

        PWM 的值可以在图形化配置界面进行配置，同时也可以通过如下函数进行设置：第一个参数是定时器，第二个是捕获比较值，第三个是通道。

void DL_Timer_setCaptureCompareValue(
    GPTIMER_Regs *gptimer, uint32_t value, DL_TIMER_CC_INDEX ccIndex);

        如下是设置占空比的一个函数。第一个参数是捕获比较值，第二个参数是设置通道，我是用一个定时器输出两路 PWM，所以需要两个通道。因为设置的是下降沿触发，系统主频是80MHz，进行了10000分频，所以计数值就是8000。duty = 7999 - 7999 * (duty/3200.0);就可以将捕获比较值从8000映射到3200。然后下面 if 来判断设置PWM输出的通道。

// 设置电机PWM占空比，取值范围为3200~0，对应占空比为100%~0%
void Motor_SetPwm(float duty,uint8_t channel) {

    duty = 7999 - 7999 * (duty/3200.0);

    if(channel==0){
        DL_TimerA_setCaptureCompareValue(PWM_MOTOR_INST , duty, DL_TIMER_CC_0_INDEX );  // 设置定时器捕获比较值
    }else {
        DL_TimerA_setCaptureCompareValue(PWM_MOTOR_INST , duty, DL_TIMER_CC_1_INDEX );  // 设置定时器捕获比较值
    }
}

        PWM 图形化配置：

 2、电机方向设置

        此函数与上面的参数一致。这两个函数分别用来设置引脚低电平和高电平。

DL_GPIO_clearPins(GPIO_MOTOR_PIN_FL1_PORT, GPIO_MOTOR_PIN_FL1_PIN);
DL_GPIO_setPins(GPIO_MOTOR_PIN_FL2_PORT, GPIO_MOTOR_PIN_FL2_PIN);

        下面函数时根据驱动电机。duty 值为正，电机正转，duty 值为负，电机反转；channel 值为0，驱动右轮，channel 值为1，驱动左轮。

// 电机前进控制函数
void Set_Speed(float duty, uint8_t channel) {
    if(channel==0){     //判断左右轮
        if(duty>0){     //判断正反转
            Motor_SetPwm(duty,channel);
            DL_GPIO_clearPins(GPIO_MOTOR_PIN_FL1_PORT, GPIO_MOTOR_PIN_FL1_PIN);
            DL_GPIO_setPins(GPIO_MOTOR_PIN_FL2_PORT, GPIO_MOTOR_PIN_FL2_PIN);
        }else if(duty<0){
            Motor_SetPwm(-duty,channel);
            DL_GPIO_clearPins(GPIO_MOTOR_PIN_FL2_PORT, GPIO_MOTOR_PIN_FL2_PIN);
            DL_GPIO_setPins(GPIO_MOTOR_PIN_FL1_PORT, GPIO_MOTOR_PIN_FL1_PIN);
        }else {
            DL_GPIO_clearPins(GPIO_MOTOR_PIN_FL1_PORT, GPIO_MOTOR_PIN_FL1_PIN);
            DL_GPIO_clearPins(GPIO_MOTOR_PIN_FL2_PORT, GPIO_MOTOR_PIN_FL2_PIN);
        }
    }else {
        if(duty>0){
            Motor_SetPwm(duty,channel);
            DL_GPIO_clearPins(GPIO_MOTOR_PIN_FR1_PORT, GPIO_MOTOR_PIN_FR1_PIN);
            DL_GPIO_setPins(GPIO_MOTOR_PIN_FR2_PORT, GPIO_MOTOR_PIN_FR2_PIN);
        }else if(duty<0){
            Motor_SetPwm(-duty,channel);
            DL_GPIO_clearPins(GPIO_MOTOR_PIN_FR2_PORT, GPIO_MOTOR_PIN_FR2_PIN);
            DL_GPIO_setPins(GPIO_MOTOR_PIN_FR1_PORT, GPIO_MOTOR_PIN_FR1_PIN);
        }else {
            DL_GPIO_clearPins(GPIO_MOTOR_PIN_FR1_PORT, GPIO_MOTOR_PIN_FR1_PIN);
            DL_GPIO_clearPins(GPIO_MOTOR_PIN_FR2_PORT, GPIO_MOTOR_PIN_FR2_PIN);
        }
    }
}

二、通用PID

        其中增量式 PID 不需要初始阈值，其输出主要是与上次误差与上上次误差有关，适合调节稳定速度；

        位置式 PID 需要初始阈值，其输出的结果与历史的状态有关，适合将速度维持在某个定值。

pid.c

#include "pid.h"
#include <math.h>

// 初始化PID结构体
void PID_Init(PID *s_PID, PID_VAR_TYPE set_point, PID_VAR_TYPE Proportion,
              PID_VAR_TYPE Integral, PID_VAR_TYPE Derivative)
{
    // 初始化PID参数
    s_PID->SetPoint = set_point;            // 设定目标值
    s_PID->Proportion = Proportion;         // 比例系数
    s_PID->Integral = Integral;             // 积分系数
    s_PID->Derivative = Derivative;         // 微分系数
    s_PID->Error = 0;                       // 当前误差
    s_PID->LastError = 0;                   // 上一次误差
    s_PID->PrevError = 0;                   // 上上次误差
    s_PID->SumError = 0;                    // 总误差
    s_PID->LastResult = 0;                  // 上一次计算结果
    s_PID->Result = 0;                      // 当前计算结果
    s_PID->OutMax = DEFAULT_PID_OUT_MAX;    // 输出上限
    s_PID->OutMin = DEFAULT_PID_OUT_MIN;    // 输出下限
    s_PID->IntegralMax = DEFAULT_PID_INTEGRAL_OUT_MAX;  // 积分输出上限
    s_PID->IntegralMin = DEFAULT_PID_INTEGRAL_OUT_MIN;  // 积分输出下限
}

// 设置PID的目标值
void PID_SetPoint(PID *s_PID, PID_VAR_TYPE set_point)
{
    s_PID->SetPoint = set_point;
}

// 设置PID的输出范围
void PID_SetOutRange(PID *s_PID, PID_VAR_TYPE outMax, PID_VAR_TYPE outMin)
{
    s_PID->OutMax = outMax;
    s_PID->OutMin = outMin;
}

// 设置PID的积分输出范围
void PID_SetIntegralOutRange(PID *s_PID, PID_VAR_TYPE outMax, PID_VAR_TYPE outMin)
{
    s_PID->IntegralMax = outMax;
    s_PID->IntegralMin = outMin;
}

// 增量型PID计算
PID_VAR_TYPE Increment_PID_Cal(PID *s_PID, PID_VAR_TYPE now_point)
{
    s_PID->LastResult = s_PID->Result;   // 保存上一次的计算结果

    // 计算误差
    s_PID->Error = s_PID->SetPoint - now_point;

    // PID计算
    s_PID->Result =
        s_PID->LastResult +
        s_PID->Proportion * (s_PID->Error - s_PID->LastError) +  // 比例项
        s_PID->Integral * s_PID->Error +                          // 积分项
        s_PID->Derivative * (s_PID->Error - 2 * s_PID->LastError + s_PID->PrevError);  // 微分项

    s_PID->PrevError = s_PID->LastError;   // 更新上上次误差
    s_PID->LastError = s_PID->Error;       // 更新上一次误差

    // 限制输出范围
    if (s_PID->Result > s_PID->OutMax)
        s_PID->Result = s_PID->OutMax;
    else if (s_PID->Result < s_PID->OutMin)
        s_PID->Result = s_PID->OutMin;

    return s_PID->Result;
}

// 位置型PID计算
PID_VAR_TYPE Position_PID_Cal(PID *s_PID, PID_VAR_TYPE now_point)
{
    s_PID->LastResult = s_PID->Result;   // 保存上一次的计算结果

    // 计算误差
    s_PID->Error = s_PID->SetPoint - now_point;
    s_PID->SumError += s_PID->Error;    // 更新总误差

    // 限制积分输出范围
    PID_VAR_TYPE IOutValue = s_PID->SumError * s_PID->Integral;
    if (IOutValue > s_PID->IntegralMax)
        IOutValue = s_PID->IntegralMax;
    else if (IOutValue < s_PID->IntegralMin)
        IOutValue = s_PID->IntegralMin;

    // PID计算
    s_PID->Result =
        s_PID->Proportion * s_PID->Error +      // 比例项
        IOutValue +                            // 积分项
        s_PID->Derivative * (s_PID->Error - s_PID->LastError);  // 微分项

    s_PID->PrevError = s_PID->LastError;   // 更新上上次误差
    s_PID->LastError = s_PID->Error;       // 更新上一次误差

    // 限制输出范围
    if (s_PID->Result > s_PID->OutMax)
        s_PID->Result = s_PID->OutMax;
    else if (s_PID->Result < s_PID->OutMin)
        s_PID->Result = s_PID->OutMin;

    return s_PID->Result;
}

// 综合型PID计算
PID_VAR_TYPE PID_Cal(PID *s_PID, PID_VAR_TYPE now_point)
{
    s_PID->LastResult = s_PID->Result;   // 保存上一次的计算结果

    // 计算误差
    s_PID->Error = s_PID->SetPoint - now_point;
    s_PID->SumError += s_PID->Error;    // 更新总误差

    // 限制积分输出范围
    PID_VAR_TYPE IOutValue = s_PID->SumError * s_PID->Integral;
    if (IOutValue > s_PID->IntegralMax)
        IOutValue = s_PID->IntegralMax;
    else if (IOutValue < s_PID->IntegralMin)
        IOutValue = s_PID->IntegralMin;

    // PID计算
    s_PID->Result =
        s_PID->Proportion * (s_PID->Error + IOutValue) +   // 比例项
        s_PID->Derivative * (s_PID->Error - s_PID->LastError);  // 微分项

    s_PID->PrevError = s_PID->LastError;   // 更新上上次误差
    s_PID->LastError = s_PID->Error;       // 更新上一次误差

    // 限制输出范围
    if (s_PID->Result > s_PID->OutMax)
        s_PID->Result = s_PID->OutMax;
    else if (s_PID->Result < s_PID->OutMin)
        s_PID->Result = s_PID->OutMin;

    return s_PID->Result;
}

pid.h

#ifndef __PID_H
#define __PID_H	  

//PID输出范围宏定义
#define DEFAULT_PID_OUT_MAX               ( 3200)
#define DEFAULT_PID_OUT_MIN               (-3200)
//PID积分范围宏定义
#define DEFAULT_PID_INTEGRAL_OUT_MAX      ( 400)
#define DEFAULT_PID_INTEGRAL_OUT_MIN      (-400)

//PID变量类型宏定义
#define PID_VAR_TYPE                            float     //int

//定义结构体
typedef struct
{
    PID_VAR_TYPE SetPoint;      // 设定目标 
    PID_VAR_TYPE Proportion;    // 比例常数
    PID_VAR_TYPE Integral;      // 积分常数
    PID_VAR_TYPE Derivative;    // 微分常数 
    PID_VAR_TYPE SumError;      // 积分和
    PID_VAR_TYPE Error;         // 误差
    PID_VAR_TYPE LastError;     // 上次误差 
    PID_VAR_TYPE PrevError;     // 前一次误差   
    PID_VAR_TYPE LastResult;    // 上次计算结果
    PID_VAR_TYPE Result;        // 当前计算结果
    PID_VAR_TYPE OutMax;        // 输出限幅最大值
    PID_VAR_TYPE OutMin;        // 输出限幅最小值
    PID_VAR_TYPE IntegralMax;   // 积分限幅最大值
    PID_VAR_TYPE IntegralMin;   // 积分限幅最小值
} PID;

extern void PID_Init(PID *s_PID, PID_VAR_TYPE set_point,
                        PID_VAR_TYPE Proportion,
                        PID_VAR_TYPE Integral,
                        PID_VAR_TYPE Derivative);  //PID初始化

extern void PID_SetOutRange(PID *s_PID, PID_VAR_TYPE outMax, PID_VAR_TYPE outMin);          //设置PID输出范围
extern void PID_SetIntegralOutRange(PID *s_PID, PID_VAR_TYPE outMax, PID_VAR_TYPE outMin);  //设置PID积分范围
extern void PID_SetPoint(PID *s_PID, PID_VAR_TYPE set_point);                               //设置目标值

extern PID_VAR_TYPE Increment_PID_Cal(PID *s_PID, PID_VAR_TYPE now_point);  //增量式PID计算
extern PID_VAR_TYPE Position_PID_Cal(PID *s_PID, PID_VAR_TYPE now_point);   //位置式PID计算
extern PID_VAR_TYPE PID_Cal(PID *s_PID, PID_VAR_TYPE now_point);            //比例外置式PID

#endif

汘荨
关注
  • 4
    点赞
  • 踩
  • 5
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
专栏目录
24年电赛-自动行驶小车（H题）基于 CCS Theia -陀螺仪 JY60 代码移植到 MSPM0G3507（附代码）
08-02
jy60部分代码
24电赛 H题 循迹小车 MSPM0G3507 源码开源
08-01
能完成所有题目要求，第（4）问单圈15s，还有优化空间
2024电赛H题参考方案（+视频演示＋核心控制代码）——自动行驶小车
热门推荐
脑壳有点痒，好像要长脑子了！
07-29 1万+
此次电赛的H题属于控制类题目，相较于往年较为简单，功能也算单一，四个题目的时间要求都不是很高，容易得分，其中主要难点可能是TI芯片了，但是资源丰富，那也就不是问题了。控制的难点就在与ABCD四点之间的丝滑连接，如何让小车又快又稳的运行，最后比拼的就是时间了，可能也是比赛现场的重点评判标准，毕竟选择该题的人多。
24年电赛——自动行驶小车（H题）基于 CCS Theia -陀螺仪 JY60 代码移植到 MSPM0G3507（附代码）
汘荨的博客
08-02 414
只要搞懂 M0 的代码结构和 CCS 的图形化配置方法，代码移植就会变的很简单。因为本次电赛的需要，正好陀螺仪部分代码的移植是我完成的。（末尾附全部代码）
MSPM0G3507（三十六）——超声波PID控制小车固定距离
2302_80529671的博客
07-13 5074
有些函数没有列出来，大家可以自己给他加上去，就是驱动电机的程序，非常简单。比如limit和load 一个是速度限幅一个是给电机加载PWM，每个人有每个人的写法，实在不会在评论区回复就行。主函数中while循环调用 Senor_control();波形图软件是VOFA，B站有教程 ，虽然有缺点但是非常简单。之前发过只有超声波测距的代码，这里只列出了超声波的所有代码。
24年电赛——自动行驶小车（H题）完赛感受
汘荨的博客
08-02 755
笔者大二，也算是第一次正式的打电赛省赛（大一电赛的时候还没接触32，校赛的时候就被刷下去了。。。经过一年的学习，三天两夜的校赛、两天一夜的七校联赛终于是挺到了省赛。比赛过程中真的是有太多感悟了。于是完赛第二天就赶出了这篇博客。
MSPM0G3507（二十四）——编码器控制速度
2302_80529671的博客
07-07 9739
链接：https://pan.baidu.com/s/1-fSQ79qrB1yw8h8KZa1mjg?源码直接分享，用的是CCStheia，KEIL打不开。大家可以看一下源码的思路，PID部分几乎不用改。绿色设置的为目标值100，红色为编码器实际数据。下面是MOTOR.C，PID和电机驱动都在里面。最后也是两者合在了一起，PID调试成功。--来自百度网盘超级会员V3的分享。
MSPM0G3507（二十）——PWM驱动舵机，模块化
2302_80529671的博客
07-02 5720
舵机PWM在配置时，一定要选择50HZ，否则舵机不能转到相应的角度。OLED和串口部分在之前已经发过。
MSPM0G3507——电赛PCB板子，小零件太多，酌情使用
2302_80529671的博客
07-25 4037
4.配有一个基于51单片机的独立电源管理与协处理器，可控制各个模块的上电时序，可对需要长时间初始化的模块，如OPEN_MV,BLE,MPU6050等模块提前上电进行初始化，也可自行读取循迹模块，将循迹模块数据通过串口发送给主机，主机也可通过串口控制各个分模块的上下电。四路舵机独享一路5V供电，同样配有独立库电容，输入输出保险丝，TVS尖峰防护二极管，舵机的PWM控制信号也带有尖峰防护，防止舵机动作可能导致的信号线尖峰。10.各路保护齐全，防护管，保险丝一应俱全，防止烧板炸板，避免重制板子的困扰。
MSPM0G3507电赛小车代码方案
m0_74147227的博客
07-24 3651
具体小车实现在以下B站链接：【MSPM0G3507小车模板，适用于两轮小车，四轮小车，调试方便，包含原理图和pcb、代码，插模块即可使用，简单易上手，车辆大小满足2024电子设计大赛电赛要求】https://www.bilibili.com/video/BV1G7e1eZEAh?为了备战2024电赛小车，移植了之前用在STM32、MSP432的小车代码模板，发现其中缺乏位带操作等，通过一些定义实现。
MSPM0G3507_2024电赛自动行驶小车(H题)_问题与感悟
NULL指向我的博客
08-02 701
这次电赛题目选的简单了，还规定不能使用到摄像头，这让我之前学习的Opencv 4与树莓派无用武之地了，但我当时对于三子棋题目饶有兴趣，但架不住队友想稳奖，只能选择这个H题了......
2024年电赛-自动行驶小车（H题）基于 CCS Theia -陀螺仪 JY60 代码移植到 MSPM0G3507（附代码）
最新发布
08-03
2024年电赛-自动行驶小车（H题）基于 CCS Theia -陀螺仪 JY60 代码移植到 MSPM0G3507（附代码） JY60
mspm0g3507-Artificial-Intelligence-P笔记
07-27
mspm0g3507-Artificial-Intelligence-P笔记
MSPM0G3507-插值函数
07-21
MSPM0G3507-插值函数
mspm0g3507代码
07-30
MSPM0G3507是一款由德州仪器（Texas Instruments，简称TI）生产的微控制器（MCU），通常用于嵌入式系统开发。由于MSPM0G3507的代码示例和具体实现可能因应用而异，且直接提供完整的代码可能超出了一般问题的范畴，我...
LP-MSPM0G3507fft实现
07-30
LP-MSPM0G3507fft实现 LP-MSPM0G3507fft实现
mspm0g3507.txt
07-30
mspm0g3507mspm0g3507.txtmspm0g3507.txtmspm0g3507.txtmspm0g3507.txtmspm0g3507.txtmspm0g3507.txtmspm0g3507.txtmspm0g3507.txtmspm0g3507.txtmspm0g3507.txtmspm0g3507.txtmspm0g3507.txtmspm0g3507.txtmspm0g...
2024年电子设计竞赛MSPM0G3507学习例程
07-29
适合H题目
LPmspm0g3507和mspm0g3507的区别
06-28
LPmspm0g3507和mspm0g3507看起来像是两个相似但可能有所区别的产品标识或型号。具体区别可能包括以下几个方面： 1. **缩写含义**：LP可能代表低功耗（Low Power）版本，表示该产品在设计上注重节能，性能可能在某些指标上有所妥协，以延长电池寿命或者降低散热需求。 2. **性能差异**：如果没有LP前缀，那么mspm0g3507可能是标准版或高性能版，这意味着它可能具有更高的处理能力、更大的内存容量或其他高级特性。 3. **价格和定位**：LP版本通常定价较低，适合对性能要求不那么高的应用场景，而标准版则可能针对性能需求较高或者对成本敏感的用户。 4. **规格更新**：有时候，型号后面数字的变化也可能表示软件升级、硬件改进或者支持的不同技术。
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

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

余额充值