单片机pid算法控制步进电机的电路图和程序
//P1.1(T0):Count They Distance
//P0.4:Tx
//P0.5:Rx
#include //SFR declarations
#include //Standard I/O definition file
#include //Math library file
#include
#include
unsigned int j,i;
char a=0;
unsigned int t=0;
//sbit led=P0^2;
//P0.0(PWM0):给定左轮速度.
sbit vls=P0^4; //P0.4(GPIO):给定左轮方向.
sbit vlf=P0^6; //P0.6(T0) :反馈左轮速度.
sbit dlf=P1^0; //P1.0(GPIO):反馈左轮方向.
//P0.2(PWM0):给定右轮速度.
sbit vrs=P0^5; //P0.5(GPIO):给定右轮方向.
sbit vrf=P0^7; //P0.7(T0) :反馈右轮速度.
sbit drf=P1^1; //P1.1(GPIO):反馈右轮方向.
int ol; //左轮给定值
int len;
int len_1,len_2;
int lyn_1,lyn_2;
int vl1,vl2; //反馈左轮速度值(取样周期内的方波数)
int lfz; //运算后赋给PWM的值
int lyn,lynn;
int lun=0,lun_1=0; //偏差校正值 即校正PWM输出
int lunp,luni,lund; //PID 校正值
int or; //右轮给定值
int ren;
int ren_1,ren_2;
int ryn_1,ryn_2;
int vr1,vr2; //反馈右轮速度值(取样周期内的方波数)
int rfz; //运算后赋给PWM的值
int ryn,rynn;
int run=0,run_1=0; //偏差校正值 即校正PWM输出
int runp,runi,rund; //PID 校正值
float kp=2.0; //比例系数1.8
float kd=0.2; //微分系数0.4
float lki; //积分系数
void pio_init(void);
void sys_init(void);
void t01_init(void);
void TIME3_INT(void);
void PID(void);
void interrupt_init(void);
void delay(unsigned int x);
void pwm1_1(void);
void main(void)
{
PCA0MD &= ~0x40; //关闭
pio_init(); //P11为测距输入端
sys_init();
t01_init();
pwm1_1();
TIME3_INT();
interrupt_init();
vls=1;vrs=0;
while(1)
{
ol=50;
or=50;
delay(1000);
ol=100;
or=100;
delay(1000);
ol=-50;
or=50;
delay(1000);
}
}
void PID(void)
{
/****************左轮PID调节******************/
if(dlf==1)
{
lyn=(vl2*256+vl1); //dlf是左轮反馈方向，0表示向前 vl=TL0
}
else
{
lyn=-(vl2*256+vl1); //dlf=1表示是向后退，速度应该为负值
}
len=ol-lyn; //误差=给定速度-反馈速度(取样周期内的方波数)
if(abs(len)<8)//30
{
lki=1.4; //ki值的确定1.4
}
else
{
lki=0.05; //积分系数：如果 | 给定值-反馈值 | 太大
} //则就可以不引入积分，或者引入的很小0.05
lunp=kp*(len-len_1); //比例校正
luni=lki*len; //积分校正
lund=kd*(len-2*len_1+len_2); //微分校正
lun=lunp+luni+lund+lun_1; //总校正
/*************新旧数据更新*************************/
len_2=len_1;
len_1=len; //len:当前取样周期内出现的速度偏差;len_1:上次取样周期内出现的速度偏差
lun_1=lun; //lun:当前取样周期内得出的PWM校正值;lun_1:上次取样周期内得出的PWM校正值
/*************新旧数据更新*************************/
if(lun>255)
{
lun=255; //正速度
}
if(lun<-255)
{
lun=-255; //负速度
}
if(lun<0)
{
vls=1;
PCA0CPH0=-lun;
}
if(lun>=0)
{
vls=0;
PCA0CPH0=lun;
}
/****************右轮PID调节******************/
if(drf==0)
{
ryn=(vr2*256+vr1); //drf是右轮反馈方向，0表示向前 vl=TL0
}
else
{
ryn=-(vr2*256+vr1); //dlf=1表示是向后退，速度应该为负值
}
ren=or-ryn; //误差=给定速度-反馈速度(取样周期内的方波数)
if(abs(ren)<8)//30
{
lki=1.4; //ki值的确定1.4
}
else
{
lki=0.05; //积分系数：如果 | 给定值-反馈值 | 太大
} //则就可以不引入积分，或者引入的很小0.05
runp=kp*(ren-ren_1); //比例校正
runi=lki*ren; //积分校正
rund=kd*(ren-2*ren_1+ren_2); //微分校正
run=runp+runi+rund+run_1; //总校正
/*************新旧数据更新*************************/
ren_2=ren_1;
ren_1=ren; //len:当前取样周期内出现的速度偏差;len_1:上次取样周期内出现的速度偏差
run_1=run; //lun:当前取样周期内得出的PWM校正值;lun_1:上次取样周期内得出的PWM校正值
/*************新旧数据更新*************************/
if(run>255)
{
run=255; //正速度
}
if(run<-255)
{
run=-255; //负速度
}
if(run<0)
{
vrs=1;
PCA0CPH1=-run;
}
if(run>=0)
{
vrs=0;
PCA0CPH1=run;
}
//因为这里的PCA0CPH0越大，对应的电机速度越小，所以要255来减一下
}
void pio_init(void)
{
XBR0=0x00; //0000 0001
XBR1=0x72; //0111 0010 时能弱上拉 T0T1连接到脚口P06、P07 CEX0、CEX1连接到脚口P00、P01
P0MDIN=0xff; //模拟(0);数字(1) 1111 0011
P0MDOUT=0xc3;//开漏(0);推挽(1) 1111 1111
P0SKIP=0x3c; //0011 1100
P1MDIN=0xff; //1111 1111
P1MDOUT=0xfc;//
P1SKIP=0x00; //1111 1111
}
void sys_init(void) //12MHz
{
OSCICL=0x43;
OSCICN=0xc2;
CLKSEL=0x00;
}
void pwm1_1(void) //PWM的初始化
{
PCA0MD=0x08; //PCA时钟为12分频
PCA0CPL0=200; //左轮
PCA0CPM0=0x42; //设置左轮为8位PWM输出
PCA0CPH0=200;
PCA0CPL1=200; //平衡校正
PCA0CPM1=0x42; //设置为8位PWM输出
PCA0CPH1=200;
PCA0CN=0x40; //允许PCA工作
}
void t01_init(void)
{
TCON=0x50; //计数器1、2允许
TMOD=0x55; //定时器1、2采用16位计数功能
CKCON=0x00;
TH1=0x00; //用于采集左轮的速度
TL1=0x00;
TH0=0x00; //用于采集右轮的速度
TL0=0x00;
}
void TIME3_INT(void)
{
TMR3CN = 0x00; //定时器3为16位自动重载
CKCON &= ~0x40;
TMR3RLL = 0xff;
TMR3RLH = 0xd7;
TMR3L = 0xff;
TMR3H = 0xd7;
TMR3CN |= 0x04;
}
void T3_ISR() interrupt 14 //定时器3中断服务程序
{
//led=~led;
EA=0;
TCON &=~0x50; //关闭计数器0、1
vl1=TL0; //取左轮速度值
vl2=TH0;
vr1=TL1; //取右轮速度值
vr2=TH1;
TH1=0x00;
TL1=0x00;
TH0=0x00;
TL0=0x00;
PID(); //PID处理
TMR3CN &=~0x80; //清中断标志位
TCON |=0x50; //重新开计数器0、1
EA=1;
}
void interrupt_init(void)
{ IE=0x80;
IP=0x00;
EIE1|=0x80;
EIP1|=0x80;
}
void delay(unsigned int m) //延时程序
{
for(i=0;i<2000;i++)
{
for(j=0;j<m;j++){_nop_(); _nop_();}
}
}
看到太多数码管和发光二极管接错的书了以及实物了。这里又是一个，呵呵。
这图proteus 可以画出来的。
一长串字母数字那个就是步进电机，ULN2003是达林顿三极管驱动。
焊接实物如果没有规定用这个电路的话，建议另外找一个。
//P0.4:Tx
//P0.5:Rx
#include <C8051F310.h> //SFR declarations
#include <stdio.h> //Standard I/O definition file
#include <math.h> //Math library file
#include <Intrins.h>
#include <absacc.h>
unsigned int j,i;
char a=0;
unsigned int t=0;
//sbit led=P0^2;
//P0.0(PWM0):给定左轮速度.
sbit vls=P0^4; //P0.4(GPIO):给定左轮方向.
sbit vlf=P0^6; //P0.6(T0) :反馈左轮速度.
sbit dlf=P1^0; //P1.0(GPIO):反馈左轮方向.
//P0.2(PWM0):给定右轮速度.
sbit vrs=P0^5; //P0.5(GPIO):给定右轮方向.
sbit vrf=P0^7; //P0.7(T0) :反馈右轮速度.
sbit drf=P1^1; //P1.1(GPIO):反馈右轮方向.
int ol; //左轮给定值
int len;
int len_1,len_2;
int lyn_1,lyn_2;
int vl1,vl2; //反馈左轮速度值(取样周期内的方波数)
int lfz; //运算后赋给PWM的值
int lyn,lynn;
int lun=0,lun_1=0; //偏差校正值 即校正PWM输出
int lunp,luni,lund; //PID 校正值
int or; //右轮给定值
int ren;
int ren_1,ren_2;
int ryn_1,ryn_2;
int vr1,vr2; //反馈右轮速度值(取样周期内的方波数)
int rfz; //运算后赋给PWM的值
int ryn,rynn;
int run=0,run_1=0; //偏差校正值 即校正PWM输出
int runp,runi,rund; //PID 校正值
float kp=2.0; //比例系数1.8
float kd=0.2; //微分系数0.4
float lki; //积分系数
void pio_init(void);
void sys_init(void);
void t01_init(void);
void TIME3_INT(void);
void PID(void);
void interrupt_init(void);
void delay(unsigned int x);
void pwm1_1(void);
void main(void)
{
PCA0MD &= ~0x40; //关闭
pio_init(); //P11为测距输入端
sys_init();
t01_init();
pwm1_1();
TIME3_INT();
interrupt_init();
vls=1;vrs=0;
while(1)
{
ol=50;
or=50;
delay(1000);
ol=100;
or=100;
delay(1000);
ol=-50;
or=50;
delay(1000);
}
}
void PID(void)
{
/****************左轮PID调节******************/
if(dlf==1)
{
lyn=(vl2*256+vl1); //dlf是左轮反馈方向，0表示向前 vl=TL0
}
else
{
lyn=-(vl2*256+vl1); //dlf=1表示是向后退，速度应该为负值
}
len=ol-lyn; //误差=给定速度-反馈速度(取样周期内的方波数)
if(abs(len)<8)//30
{
lki=1.4; //ki值的确定1.4
}
else
{
lki=0.05; //积分系数：如果 | 给定值-反馈值 | 太大
} //则就可以不引入积分，或者引入的很小0.05
lunp=kp*(len-len_1); //比例校正
luni=lki*len; //积分校正
lund=kd*(len-2*len_1+len_2); //微分校正
lun=lunp+luni+lund+lun_1; //总校正
/*************新旧数据更新*************************/
len_2=len_1;
len_1=len; //len:当前取样周期内出现的速度偏差;len_1:上次取样周期内出现的速度偏差
lun_1=lun; //lun:当前取样周期内得出的PWM校正值;lun_1:上次取样周期内得出的PWM校正值
/*************新旧数据更新*************************/
if(lun>255)
{
lun=255; //正速度
}
if(lun<-255)
{
lun=-255; //负速度
}
if(lun<0)
{
vls=1;
PCA0CPH0=-lun;
}
if(lun>=0)
{
vls=0;
PCA0CPH0=lun;
}
/****************右轮PID调节******************/
if(drf==0)
{
ryn=(vr2*256+vr1); //drf是右轮反馈方向，0表示向前 vl=TL0
}
else
{
ryn=-(vr2*256+vr1); //dlf=1表示是向后退，速度应该为负值
}
ren=or-ryn; //误差=给定速度-反馈速度(取样周期内的方波数)
if(abs(ren)<8)//30
{
lki=1.4; //ki值的确定1.4
}
else
{
lki=0.05; //积分系数：如果 | 给定值-反馈值 | 太大
} //则就可以不引入积分，或者引入的很小0.05
runp=kp*(ren-ren_1); //比例校正
runi=lki*ren; //积分校正
rund=kd*(ren-2*ren_1+ren_2); //微分校正
run=runp+runi+rund+run_1; //总校正
/*************新旧数据更新*************************/
ren_2=ren_1;
ren_1=ren; //len:当前取样周期内出现的速度偏差;len_1:上次取样周期内出现的速度偏差
run_1=run; //lun:当前取样周期内得出的PWM校正值;lun_1:上次取样周期内得出的PWM校正值
/*************新旧数据更新*************************/
if(run>255)
{
run=255; //正速度
}
if(run<-255)
{
run=-255; //负速度
}
if(run<0)
{
vrs=1;
PCA0CPH1=-run;
}
if(run>=0)
{
vrs=0;
PCA0CPH1=run;
}
//因为这里的PCA0CPH0越大，对应的电机速度越小，所以要255来减一下
}
void pio_init(void)
{
XBR0=0x00; //0000 0001
XBR1=0x72; //0111 0010 时能弱上拉 T0T1连接到脚口P06、P07 CEX0、CEX1连接到脚口P00、P01
P0MDIN=0xff; //模拟(0);数字(1) 1111 0011
P0MDOUT=0xc3;//开漏(0);推挽(1) 1111 1111
P0SKIP=0x3c; //0011 1100
P1MDIN=0xff; //1111 1111
P1MDOUT=0xfc;//
P1SKIP=0x00; //1111 1111
}
void sys_init(void) //12MHz
{
OSCICL=0x43;
OSCICN=0xc2;
CLKSEL=0x00;
}
void pwm1_1(void) //PWM的初始化
{
PCA0MD=0x08; //PCA时钟为12分频
PCA0CPL0=200; //左轮
PCA0CPM0=0x42; //设置左轮为8位PWM输出
PCA0CPH0=200;
PCA0CPL1=200; //平衡校正
PCA0CPM1=0x42; //设置为8位PWM输出
PCA0CPH1=200;
PCA0CN=0x40; //允许PCA工作
}
void t01_init(void)
{
TCON=0x50; //计数器1、2允许
TMOD=0x55; //定时器1、2采用16位计数功能
CKCON=0x00;
TH1=0x00; //用于采集左轮的速度
TL1=0x00;
TH0=0x00; //用于采集右轮的速度
TL0=0x00;
}
void TIME3_INT(void)
{
TMR3CN = 0x00; //定时器3为16位自动重载
CKCON &= ~0x40;
TMR3RLL = 0xff;
TMR3RLH = 0xd7;
TMR3L = 0xff;
TMR3H = 0xd7;
TMR3CN |= 0x04;
}
void T3_ISR() interrupt 14 //定时器3中断服务程序
{
//led=~led;
EA=0;
TCON &=~0x50; //关闭计数器0、1
vl1=TL0; //取左轮速度值
vl2=TH0;
vr1=TL1; //取右轮速度值
vr2=TH1;
TH1=0x00;
TL1=0x00;
TH0=0x00;
TL0=0x00;
PID(); //PID处理
TMR3CN &=~0x80; //清中断标志位
TCON |=0x50; //重新开计数器0、1
EA=1;
}
void interrupt_init(void)
{ IE=0x80;
IP=0x00;
EIE1|=0x80;
EIP1|=0x80;
}
void delay(unsigned int m) //延时程序
{
for(i=0;i<2000;i++)
{
for(j=0;j<m;j++){_nop_(); _nop_();}
}
}
看你这么问就知道你什么都没明白！
步进电机控制电路
步进电机控制程序，程序使用pid算法
pid算法的实现，必须有控制数值，控制输出，输出的反馈，是闭环控制
还有分这么低，都没人主动应答你
单片机pid算法控制步进电机的电路图和程序
答：int run=0,run_1=0; //偏差校正值 即校正PWM输出 int runp,runi,rund; //PID 校正值 float kp=2.0; //比例系数1.8 float kd=0.2; //微分系数0.4 float lki; //积分系数 void pio_init(void);void sys_init(void);void t01_init(void);void TIME3_INT(void);void PID(void)...
如何用单片机控制步进电机?
答：该电路是一个步进电机驱动电路，通过控制脉冲Ui，可以实现步进电机的转动。步进电机的一个线圈被表示为图中的W，通过光耦OT和脉冲变压器T与控制脉冲Ui相连。当控制脉冲Ui为高电平时，光耦OT导通，使得线圈W接收到脉冲信号，产生磁场，推动步进电机转动一个步进角度。当控制脉冲Ui为低电平时，光耦OT截断，线...
单片机控制步进电机程序
答：单片机控制步进电机的程序主要通过设置适当的控制信号序列，以驱动步进电机的各相线圈，从而实现电机的旋转和定位。这通常涉及到对单片机I/O端口的编程，以及对步进电机驱动器或控制器的接口操作。详细 步进电机是一种将电脉冲信号转换成相应角位移或线位移的电动机。在非超载的情况下，电机的转速、停止的位...
如何使用单片机精确控制步进电机?
答：要使用步进电机转动，只要轮流给各引出端通电即可。将COM端标识为C，只要AC、C、BC、C，轮流加电就能驱动步进电机运转，加电的方式可以有多种，如果将COM端接正电源，那么只要用开关元件（如三极管），将A、B、轮流接地。列出了该电机的一些典型参数：表135BY48S03型步机电机参数型号步距角相数电压...
单片机控制步进电机的原理?
答：步进电机是数字控制电机，它将脉冲信号转变成角位移，即给一个脉冲信号，步进电机就转动一个角度，因此非常适合于单片机控制。步进电机可分为反应式步进电机（简称VR）、永磁式步进电机（简称PM）和混合式步进电机（简称HB）。步进电机区别于其他控制电机的最大特点是，它是通过输入脉冲信号来进行控制的，即...
步进电机用单片机控制转动
答：很简单，看你的意思，你应该已经有了与之配套的【步进电机驱动器】，那就可以用单片机I/O口控制了，一路输出CP脉冲信号，一路输出DIR方向信号，电源接好后，连通电路，就OK了。简单的C51调试程序：一个大的FOR循环里包含：【C P脉冲信号】：可以用一个有限的FOR循环（循环时间可控制在几秒钟左右）...
步进电机的单片机控制
答：1、对步进电机的控制和驱动，设计中受控电机为四相六线制的步进电机（内阻33欧，步进1.8度，额定电压12V）使用L298N芯片驱动电机 L298N芯片可以驱动两个二相电机（如图1－1），也可以驱动一个四相电机，输出电压最高可达50V，可以直接通过电源来调节输出电压；可以直接用单片机的IO口提供信号；而且电路...
单片机步进电机控制实验 单片机步进电机控制实验报告
答：2、实验设备。单片机测控实验、系统步进电机控制实验模块、Keil开发环境、STC-ISP程序下载工具。3、实验内容。编制MCS-51程序使步进电机按照规定的转速和方向进行旋转，并将已转动的步数显示在数码管上。步进电机的转速分为两档，当按下S1开关时，加速旋转，速度从10转/分加速到60转/分。当松开开关时，...
求高手指点,如何用单片机控制步进电机?
答：步进电机是每个脉冲转固定的角度，转速的控制实际上是对脉冲频率的控制。所以用有PWM功能的单片机就可以实现转速的控制，某些51单片机也有此功能。也可以选用AVR或者MSP430等单片机。编程的时候可以结合计数器。电路设计时需要可以提供足够的驱动电流的驱动芯片才可以，如达林顿管或者是L298N等等。
基于单片机步进电机自动控制系统设计
答：要求1、学习单片机、步进电机等相关知识2、研究步进电机原理及工作模式,选择合适单片机设计一个步进电机控制器,要求a、在速度模式下用四个按键控制电机的启动/停止、加速、减速、反... 要求1、学习单片机、步进电机等相关知识 2、研究步进电机原理及工作模式,选择合适单片机设计一个步进电机控制器,要求a、在速度模式下...
