Arduino中手写脉冲控制步进电机-2
目录
1、前言
2、时间-位移关系计算
3、Matlab计算时间和位置数据
(1)Matlab程序
（2）Arduino程序
4、Matlab生成Arduino电机正反转程序语句
（1）Arduino程序
（2）Matlab 命令行方式生成Arduino步进电机正反转程序语句
①正转命令行
②反转命令行
（3）Matlab GUI方式生成Arduino步进电机正反转程序语句
5、下载链接
1、前言
Arduino中手写脉冲控制步进电机-1-CSDN博客 接上一节继续。上一节是实现步进电机恒速运转，要实现电机变速运动需要对脉冲延时函数进行调整。本节主要讲解电机固定位置往复运动、速度以曲线方式运行。
2、时间-位移关系计算
步进电机时间-位移关系拟合三角函数。从Cos函数曲线上采样、取很多个点，取样点越细电机运行就越圆滑。
思路：对于一个 时间-位移 三角函数，每隔相同的时长（称为单元时长）取一次位移值，计算相邻
两次位移的距离(的绝对值)，再计算对应的脉冲步数的delay时长
1、距离固定后，脉冲步数固定。
2、由于单元时长固定，因此每步的脉冲时长(脉冲频率)也是固定的。但是不同单元的脉冲频率不同
3、即固定单元时长，但不固定单元内步数，因此单元的脉冲频率也不固定
类似于这样，然后使电机的时间-位移关系，满足相邻红星的时间-位移关系即可。
3、Matlab计算时间和位置数据
(1)Matlab程序
运行的.m脚本程序
%% 1.步进电机PWM计算代码
clc
clear
close all
%% 原始值
A=40.64; %振幅*2，两倍振幅，即伸缩杆的移动范围。电机1600脉冲转一圈，40.64=1600*。0.254
MBJL=0.0254; %每步距离,电机固定参数(与细分数有关)
T=2; %三角函数的周期2秒，即2秒执行完给定的脉冲数
T=T*1000*1000; %换算为微秒
SN=A/MBJL; %StepNumber，三角函数一个周期内的脉冲步数,振幅固定后SN即固定
TPSN=T/SN; %TimePerStep，每步的时长的平均值
UN=20; %UnitNumber，一个周期平均分割的单元总数
%函数
x=2*pi/SN:2*pi/SN:2*pi; %自变量
y=func(x,A); %函数
% %函数：脉冲数-位移图
% figure(1)
% plot(1:SN,y,'b.','markersize',15,'LineWidth',1)
% xlabel('脉冲数')
% ylabel('位移/mm')
% ZT=30;%字体30号
% set(gca,'FontSize',ZT);
% aaa=2;
% set(gcf,'unit','centimeters','position',[2 2 16*aaa 9*aaa]);
% set(gca,"FontName","宋体","FontSize",ZT,"LineWidth",2);
%
% %目标函数图（理想函数图）
% figure(2)
% plot((1:SN)*TPSN,y,'b.','markersize',15,'LineWidth',1)
% xlabel('时间/微秒')
% ylabel('位移/mm')
% ZT=30;%字体30号
% set(gca,'FontSize',ZT);
% aaa=2;
% set(gcf,'unit','centimeters','position',[2 2 16*aaa 9*aaa]);
% set(gca,"FontName","宋体","FontSize",ZT,"LineWidth",2);
%%
NN=1:SN/UN:SN; %平均分割的脉冲坐标
NN(length(NN)+1)=SN;
x0=zeros(1,length(NN));
for i=1:length(NN)
x0(1,i)=x(NN(1,i)); %平均分割的脉冲坐标对应的x坐标
end
y0=func(x0,A); %x坐标对应的位移
y01=y0(1:(length(NN)-1));
y02=y0(2:(length(NN)));
y00=y02-y01;
%求解
MCZS=abs(y00/0.0254); %一个单元内的脉冲总数
MCZS=round(MCZS);
PJBC=(T/UN)./MCZS; %每单元的平均步长，微秒,脉冲总数需要四舍五入
PJBC=round(PJBC);
%结果
Result_mc=MCZS;
Result_bc=PJBC;
%% 还原函数图
MCZS000=y00/0.0254; %一个单元内的脉冲总数
MCZS000=round(MCZS000);
x1=MCZS000*MBJL;
JLJL=zeros(1,UN); %积累距离，mm
for i=1:UN
JLJL(i)=sum(x1(1:i));
end
x2=MCZS.*PJBC;
JLSJ=zeros(1,UN); %积累时间，微秒
for i=1:UN
JLSJ(i)=sum(x2(1:i));
end
figure(3)
plot((1:SN)*TPSN,y,'b.-','markersize',5,'LineWidth',5)
hold on
plot(JLSJ,JLJL+abs(min(JLJL)),'r*-','markersize',10,'LineWidth',2)
xlabel('时间/微秒')
ylabel('位移/mm')
legend('理想时间位移函数','还原时间位移关系')
ZT=30;%字体30号
set(gca,'FontSize',ZT);
aaa=2;
set(gcf,'unit','centimeters','position',[2 2 16*aaa 9*aaa]);
set(gca,"FontName","宋体","FontSize",ZT,"LineWidth",2);func函数。保存位func.m脚本程序。
function y=func(x,A)
y=A/2*cos(x)+A/2;（2）计算结果
将计算的数据带到Arduino程序中
（2）Arduino程序
#define STEPPIN 7 //脉冲位为7
#define DIRPIN 6 //方向位为6
#define bushu 1600 //脉冲步数 1600个脉冲转一圈()
void setup() {
pinMode(STEPPIN, OUTPUT);
pinMode(DIRPIN, OUTPUT);
Serial.begin(9600);
}
//循环
void loop()
{
//不论电机初始位置如何，使电机超量程运动，以达到复位效果
//1.正转一圈
Serial.println("Forward Begins"); //串口监视器输出引号内容
digitalWrite(DIRPIN, HIGH); //方向引脚高电位，正转
// 正向转（1001步）
for (int x = 0; x < bushu+1; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(500); //Microseconds是微秒
digitalWrite(STEPPIN, LOW);
delayMicroseconds(500); //Microseconds是微秒
}
Serial.println("Forward Ends"); //串口监视器输出引号内容
delay(1000); // 暂停1秒
//2.逆转1圈
Serial.println("Backward Begins"); //串口监视器输出引号内容
digitalWrite(DIRPIN, LOW); //方向引脚低电位，逆转
// 反向转（bushu脉冲）
for (int x = 0; x < bushu+1; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(500); //Microseconds是微秒
digitalWrite(STEPPIN, LOW);
delayMicroseconds(500); //Microseconds是微秒
}
Serial.println("Backward Ends"); //串口监视器输出引号内容
delay(1000); //暂停1秒
//3.
Serial.println("Forward Begins"); //串口监视器输出引号内容
digitalWrite(DIRPIN, HIGH); //方向引脚高电位，正转
// 正向转
for (int x = 0; x < 40; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(2500);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(2500);
}
for (int x = 0; x < 115; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(870);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(870);
}
for (int x = 0; x < 178; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(562);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(562);
}
for (int x = 0; x < 223; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(448);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(448);
}
for (int x = 0; x < 247; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(405);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(405);
}
for (int x = 0; x < 247; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(405);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(405);
}
for (int x = 0; x < 223; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(448);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(448);
}
for (int x = 0; x < 176; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(568);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(568);
}
for (int x = 0; x < 113; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(885);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(885);
}
for (int x = 0; x < 38; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(2632);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(2632);
}
delay(1000); //暂停1秒
//4.
Serial.println("Backward Begins");//串口监视器输出引号内容
digitalWrite(DIRPIN, LOW);//方向引脚低电位，逆转
// 正向转
for (int x = 0; x < 40; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(2500);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(2500);
}
for (int x = 0; x < 115; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(870);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(870);
}
for (int x = 0; x < 178; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(562);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(562);
}
for (int x = 0; x < 223; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(448);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(448);
}
for (int x = 0; x < 247; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(405);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(405);
}
for (int x = 0; x < 247; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(405);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(405);
}
for (int x = 0; x < 223; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(448);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(448);
}
for (int x = 0; x < 176; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(568);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(568);
}
for (int x = 0; x < 113; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(885);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(885);
}
for (int x = 0; x < 38; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(2632);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(2632);
}
delay(1000); //暂停1秒
}4、Matlab生成Arduino电机正反转程序语句
（1）Arduino程序
循环程序中，1和2是恒速方式运行。3和4是曲线方式正反转，使用Matlab生成的语句和数据。Matlab生成的程序语句直接复制到3和4中。
#define STEPPIN 7 //脉冲位为7
#define DIRPIN 6 //方向位为6
#define bushu 1600 //脉冲步数 1600个脉冲转一圈()
void setup() {
pinMode(STEPPIN, OUTPUT);
pinMode(DIRPIN, OUTPUT);
Serial.begin(9600);
}
//循环
void loop()
{
//不论电机初始位置如何，使电机超量程运动，以达到复位效果
//1.正转一圈
Serial.println("Forward Begins"); //串口监视器输出引号内容
digitalWrite(DIRPIN, HIGH); //方向引脚高电位，正转
// 正向转（1001步）
for (int x = 0; x < bushu+1; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(500); //Microseconds是微秒
digitalWrite(STEPPIN, LOW);
delayMicroseconds(500); //Microseconds是微秒
}
Serial.println("Forward Ends"); //串口监视器输出引号内容
delay(1000); // 暂停1秒
//2.逆转1圈
Serial.println("Backward Begins"); //串口监视器输出引号内容
digitalWrite(DIRPIN, LOW); //方向引脚低电位，逆转
// 反向转（bushu脉冲）
for (int x = 0; x < bushu+1; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(500); //Microseconds是微秒
digitalWrite(STEPPIN, LOW);
delayMicroseconds(500); //Microseconds是微秒
}
Serial.println("Backward Ends"); //串口监视器输出引号内容
delay(1000); //暂停1秒
//3、曲线方式正转一圈
Serial.println("Forward Begins"); //串口监视器输出引号内容
digitalWrite(DIRPIN, HIGH); //方向引脚高电位，正转
// 正向转
for (int x = 0; x <40; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(5000);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(5000);
}
for (int x = 0; x <115; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(1739);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(1739);
}
for (int x = 0; x <178; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(1124);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(1124);
}
for (int x = 0; x <223; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(897);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(897);
}
for (int x = 0; x <247; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(810);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(810);
}
for (int x = 0; x <247; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(810);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(810);
}
for (int x = 0; x <223; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(897);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(897);
}
for (int x = 0; x <176; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(1136);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(1136);
}
for (int x = 0; x <113; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(1770);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(1770);
}
for (int x = 0; x <38; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(5263);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(5263);
}
delay(1000); //鏆傚仠1绉?
//4、曲线方式正转一圈
Serial.println("Backward Begins");//串口监视器输出引号内容
digitalWrite(DIRPIN, LOW);//方向引脚低电位，逆转
// 反向转
for (int x = 0; x <40; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(5000);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(5000);
}
for (int x = 0; x <115; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(1739);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(1739);
}
for (int x = 0; x <178; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(1124);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(1124);
}
for (int x = 0; x <223; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(897);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(897);
}
for (int x = 0; x <247; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(810);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(810);
}
for (int x = 0; x <247; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(810);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(810);
}
for (int x = 0; x <223; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(897);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(897);
}
for (int x = 0; x <176; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(1136);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(1136);
}
for (int x = 0; x <113; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(1770);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(1770);
}
for (int x = 0; x <38; x ++) {
digitalWrite(STEPPIN, HIGH);
delayMicroseconds(5263);
digitalWrite(STEPPIN, LOW);
delayMicroseconds(5263);
}
delay(1000); //延时1秒?
}（2）Matlab 命令行方式生成Arduino步进电机正反转程序语句
在前面Matlab程序计算出来时间、脉冲步数数据后，将计算结果一个一个写到程序语句中。这样操作非常的慢和低效，可以使用Matlab命令行来操作。
①正转命令行
%% 2.自动化语句生成代码（1）正向转
clc
Result_bc_str=num2str(Result_bc(1));
Result_mc_str=num2str(Result_mc(1));
%% 正向转
for iii=1:length(Result_bc)/2
%记录步数
s11=' for (int x = 0; x <';
s21=num2str(Result_mc(iii));
s31='; x ++) {';
s1 = strcat(s11,s21,s31);
%记录delay时长
s12=' delayMicroseconds(';
s22=num2str(Result_bc(iii));
s32=');';
s2 = strcat(s12,s22,s32);
%合成语句
disp([s1 newline ' digitalWrite(STEPPIN, HIGH);' newline s2 newline ' digitalWrite(STEPPIN, LOW);' newline s2 newline ' }'])
end
disp([' delay(1000); //暂停1秒' newline
生成程序语句替换到Arduino第三段正转控制中
②反转命令行
%% 2.自动化语句生成代码（2）逆向转
clc
Result_bc_str=num2str(Result_bc(1));
Result_mc_str=num2str(Result_mc(1));
%% 正向转
for iii=length(Result_bc)/2+1:length(Result_bc)
%记录步数
s11=' for (int x = 0; x <';
s21=num2str(Result_mc(iii));
s31='; x ++) {';
s1 = strcat(s11,s21,s31);
%记录delay时长
s12=' delayMicroseconds(';
s22=num2str(Result_bc(iii));
s32=');';
s2 = strcat(s12,s22,s32);
%合成语句
disp([s1 newline ' digitalWrite(STEPPIN, HIGH);' newline s2 newline ' digitalWrite(STEPPIN, LOW);' newline s2 newline ' }'])
end
disp([' delay(1000); //暂停1秒' newline])
生成的程序复制到Arduino中
（3）Matlab GUI方式生成Arduino步进电机正反转程序语句
GUI通过.m脚本程序运行生成。脚本程序见下载链接
5、下载链接
https://download.csdn.net/download/panjinliang066333/88670374
参考博客
【Arduino步进电机】【5.1】PWM代码(1)_arduino pwm 步进电机-CSDN博客