基于步进电机的取放机器人运动平滑优化方案问询

问题根源分析 #

你的代码加减速逻辑完全失效，核心问题出在step函数的循环结构：每次执行完一步后，直接进入嵌套的for+while循环，会一次性把mspeed直接跳到目标值，导致电机第一次步进就达到最高速，后续全程匀速，完全没有逐步加减速的过程。此外，全局变量mspeed在多电机场景下会引发冲突，也需要调整。

修正后的代码实现 #

1. 修改类定义（stepperMotor.h） #

首先把mspeed改为类私有成员，避免全局变量冲突：

#ifndef STEPPERMOTOR_H
#define STEPPERMOTOR_H

#include "mbed.h"

class sMotor {
public:
    sMotor(PinName A0, PinName A1, PinName A2, PinName A3);
    void anticlockwise();
    void clockwise();
    void step(int num_steps, int direction, int target_speed, int min_speed = 400, int max_speed = 250);
private:
    DigitalOut _A0, _A1, _A2, _A3;
    int mspeed; // 改为类私有成员
    const int speed_step = 10; // 每次加减速的步长
};

#endif

2. 修正cpp文件逻辑 #

#include "stepperMotor.h"
#include "mbed.h"

sMotor::sMotor(PinName A0, PinName A1, PinName A2, PinName A3) : _A0(A0), _A1(A1), _A2(A2), _A3(A3)
{
    _A0 = 0;
    _A1 = 0;
    _A2 = 0;
    _A3 = 0;
    mspeed = 400; // 初始化到最低速
}

void sMotor::anticlockwise()
{
    static const int seq[8][4] = {
        {0,0,1,0},
        {0,0,0,0},
        {0,0,0,1},
        {0,1,0,1},
        {0,1,1,1},
        {1,1,1,1},
        {1,0,1,1},
        {1,0,1,0}
    };
    for(int i=0; i<8; i++){
        _A0 = seq[i][0];
        _A1 = seq[i][1];
        _A2 = seq[i][2];
        _A3 = seq[i][3];
        wait_us(mspeed);
    }
}

void sMotor::clockwise()
{
    static const int seq[8][4] = {
        {0,0,0,1},
        {0,0,1,1},
        {0,0,1,0},
        {0,1,1,0},
        {0,1,0,0},
        {1,1,0,0},
        {1,0,0,0},
        {1,0,0,1}
    };
    for(int i=0; i<8; i++){
        _A0 = seq[i][0];
        _A1 = seq[i][1];
        _A2 = seq[i][2];
        _A3 = seq[i][3];
        wait_us(mspeed);
    }
}

void sMotor::step(int num_steps, int direction, int target_speed, int min_speed, int max_speed)
{
    int count = 0;
    // 计算加速区和减速区的步数（各占总步数的1/4，确保总步数足够时才会有匀速段）
    int accel_steps = num_steps / 4;
    int decel_start = num_steps - accel_steps;

    while(count < num_steps){
        // 根据当前步数调整速度
        if(count < accel_steps){
            // 加速阶段：减小mspeed（wait_us值越小，速度越快）
            if(mspeed > max_speed){
                mspeed -= speed_step;
            }
        } else if(count >= decel_start){
            // 减速阶段：增大mspeed
            if(mspeed < min_speed){
                mspeed += speed_step;
            }
        }
        // 执行一步
        if(direction == 0){
            clockwise();
        } else {
            anticlockwise();
        }
        count++;
    }
    // 运动结束后恢复到最低速，避免下次启动直接高速
    mspeed = min_speed;
}

关键修改说明 #

1. 速度变量私有化：把mspeed改为类私有成员，多电机独立控制时不会互相干扰。
2. 重构加减速逻辑：每走一步就判断当前处于加速、匀速还是减速阶段，每次只调整一次速度值，实现平滑的逐步变速。
3. 简化步进序列：用二维数组存储步进序列，代码更简洁易维护。
4. 边界值保护：加减速时判断当前速度是否在合理范围内（min_speed和max_speed），避免超出电机可控范围。
5. 运动后复位速度：每次运动结束后把速度恢复到最低速，确保下次启动从低速开始加速。

使用示例 #

#include "stepperMotor.h"
#include "mbed.h"

// 初始化三个电机
sMotor motor1(PA_0, PA_1, PA_2, PA_3);
sMotor motor2(PB_0, PB_1, PB_2, PB_3);
sMotor motor3(PC_0, PC_1, PC_2, PC_3);

int main() {
    while(1){
        // 电机1顺时针走2000步，目标速度250us（对应约500步/秒），最低速400us
        motor1.step(2000, 0, 250);
        wait(1);
        // 电机1逆时针走2000步
        motor1.step(2000, 1, 250);
        wait(1);
    }
}

内容的提问来源于stack exchange，提问作者Anshul Lanjewar