直流电机PID转速闭环调速控制系统

在工业自动控制系统和各种智能产品中常常会用用电动机进行驱动、传动和控制,而现代智能控制系统中,对电机的控制要求越来越精确和迅速,对环境的适应要求越来越高。随着科技的发展,通过对电机的改造,出现了一些针对各种应用要求的电机,如伺服电机、步进电机、开关磁阻电机等非传统电机。但是在一些对位置控制要求不高的电机控制系统如传动控制系统中,传统电机如直流电机乃有很大的优势,而要对其进行精确而又迅速的控制,就需要复杂的控制系统。随着微电子和计算机的发展,数字控制系统应用越来越广泛,数字控制系统有控制精确,硬件实现简单,受环境影响小,功能复杂,系统修改简单,有很好的人机交换界面等特点。
在电机控制系统开发中,常常需要消耗各种硬件资源,系统构建时间长,而在调试时很难对硬件系统进行修改,从而延长开发周期。随着计算机仿真技术的出现和发展,可用计算机对电机控制系统进行仿真,从而减小系统开发开支和周期。计算机仿真可分为整体仿真
和实时仿真。整体仿真是对系统各个时间段对各个对象进行计算和分析,从而对各个对象的变化情况有直观的整体的了解,即能对系统进行精确的预测,如Matlab就是一个典型的实时仿真软件。实时仿真是对时间点的动态仿真,即随着时间的推移它能动态仿真出当时系统的状态。Proteus是一个实时仿真软件,用来仿真各种嵌入式系统。它能对各种微控制器进行仿真,本系统即用Proteus对直流电机控制系统进行仿真。
在系统软件开发中开发中可用操作系统,也可不用操作系统。如用操作系统,程序可实现模块化,并能对系统资源进行统筹管理,最主要的是可实现多任务运行。如果需要多任务并行运行,并且需要一定的时间间隔,某些任务对时间的要求不高时,如不用操作系统则要占用定时器资源,并且对栈空间和硬件资源很难进行管理,所以在这种情况下需要操作系统。本系统用操作系统uC/COS.
uC/COS是一个完整的、可移植、可固化、可剪裁的占先式实时多任务内核.uC/COS
已经有很多产品成功使用的案例且得到美国军方的认证,说明了该系统的可靠性。uC/COS
源代码公开,代码短,源代码大部分是使用ANSI C编写的,移植性和裁减性好,功能强大,
能可靠应用于各种控制系统中。
   系统构成

在这里插入图片描述

硬件全图
在这里插入图片描述

各子系统
1. 转速控制输入
如用按键输入则需要复杂的软件实现,并且需要足够的引脚资源,本系统用ADC0832采样电位器上的电压信号来实现转速信号输入。
在这里插入图片描述

2.LPC2106微控制器
LPC2106是Phlip公司推出的核心为ARM的控制器。LPC2106 包含一个支持仿真的ARM7TDMI-S CPU、与片内存储器控制器接口的ARM7 局部总线、与中断控制器接口的AMBA 高性能总线(AHB)和连接片内外设功能的VLSI 外设总线(VPB,ARMAMBA 总线的兼容超集)。片内有64K 字节静态RAM和128K的FLASH存储器。可寻址4GB。
在本仿真中LPC2106没加晶振电路,频率在芯片属性中设置。
在这里插入图片描述

3.液晶显示
本系统采用Proteus仿真库有的液晶显示模块AMPIRE128X64,为8192像素的单色LCD
屏幕分为两半控制,控制引脚为CS1和CS2。数据通过移位寄存器输入。

在这里插入图片描述

4.电机驱动电路
本系统仿真的是最大输入电压为12伏的微型电机,故用通用电机驱动电路实现假设该电路输入电阻为无穷大,输出电阻为0。
在这里插入图片描述

5.仿真电机的51单片机
虽然Proteus有电机模块,但其电机模块没有输出转速接口故用一单片机代替它,单片机用ADC0832采样输入的电压,经过处理即输出和真实电机同步的转速(需要大量的浮点运算,可考虑用DSP)。通过两个按键改变转矩没按一次增大或减小0.001,上面的是增大。
在这里插入图片描述

6.仿真结果
仿真1.8秒钟后得下图,可看到转速逐渐增大然后稳定下来。
在这里插入图片描述

增大转矩后,可看到转速下降后又恢复

在这里插入图片描述

/******************************************************************************
**       实时微型直流电机PID转速闭环调速控制系统程序(基于移植于LPC2106上的uc/cos实时操作系统)
**                            
******************************************************************************/
#include "config.h"
#include "LCD.h"

#define  TASK_STK_SIZE                  512	   //各任务栈大小
#define  IO_Init()       \
          PINSEL0= 2;    \
		  IODIR|= 0x00007FB0;			  //P0.4\P0.5\P0.7-P1.4为输出其他的为输入
#define  Umax 1000						   //最大调节转速
#define  Kp 0.7							   //比例放大系数
#define  Ts 0.03							   //采样周期
#define  t0 4								   //积分时间常数
#define  td 0.0005							   //微分时间常数
#define  q0  Kp*(1+Ts*t0+td/Ts)
#define  q1  -Kp*(1+2*td/Ts) 
#define  q2  Kp*td/Ts
#define  ADC_DO	 0x00000040		       //P0.6
#define  ADC_CS	 0x00000080		       //P0.7
#define  ADC_CLK 0x00000100			   //P0.8
#define  ADC_DI  0x00000200			   //P0.9
OS_STK        Main_TaskStk[TASK_STK_SIZE];
OS_STK        Task1_TaskStk[TASK_STK_SIZE];
OS_STK        Task2_TaskStk[TASK_STK_SIZE];
OS_STK        Task3_TaskStk[TASK_STK_SIZE];
OS_STK        Task4_TaskStk[TASK_STK_SIZE];		//各任务栈
OS_EVENT      *Conbox;							   //控制信号邮箱
float n=0;										       // 输入转速
float nb=0;										   // 反馈转速
void Main_Task(void *data);
void Task1(void *p_arg);
void Task2(void *p_arg);
void Task3(void *p_arg);
void Task4(void *p_arg);						 //函数声明
void PWMInit(void)							   
{
   
    PWMPR = 0x00;			    // 不分频,计数频率为Fpclk
    PWMMCR = 0x02;			    // 设置PWMMR0匹配时复位PWMTC
	PWMMR0 = 2765;    		    // 设置PWM周期
    PWMMR1 = 0;			    // 设置PWM占空比
    PWMLER = 0x03;			    // PWMMR0、PWMMR1锁存
    PWMPCR = 0x0200;			// 允许PWM1输出,单边PWM
    PWMTCR = 0x09;			    // 启动定时器,PWM使能
	PWMMR0 = 2765;    		    // 设置PWM周期
    PWMMR1 = 0;			    // 设置PWM占空比
    PWMLER = 0x03;			    // PWMMR0、PWMMR1锁存

}
/*********************************************************************************************************
** 函数名称: main
** 功能描述: c语言的主函数,由它启动多任务环境
********************************************************************************************************/
int main (void)
{
   
    OSInit();
    OSTaskCreate(Main_Task, (void*)0, &Main_TaskStk[TASK_STK_SIZE - 1], 0);
    OSStart();
	return 0;
}
                        
/******************************************************************************
** 函数名称: Main_Task
** 功能描述: 初始化系统及建立任务
******************************************************************************/
  void  Main_Task(void *p_arg)
{
     
   p_arg = p_arg;                                         // 避免编译警告 
   TargetInit();
   IO_Init();                                      
   Conbox = OSMboxCreate((void*)0);	
   LCD_Main();	
   OSTaskCreate(Task1, (void *)0, &Task1_TaskStk[TASK_STK_SIZE - 1], 2);
   OSTaskCreate(Task2, (void *)0, &Task2_TaskStk[TASK_STK_SIZE - 1], 3);
   OSTaskCreate(Task3, (void *)0, &Task3_TaskStk[TASK_STK_SIZE - 1], 1);
   OSTaskCreate(Task4, (void *)0, &Task4_TaskStk[TASK_STK_SIZE - 1], 5);
   OSTaskSuspend(0);
}

/******************************************************************************
** 函数名称: Task1_Task
** 功能描述: 实时任务,负责采样和处理数据
******************************************************************************/
 void Task1(void *p_arg)   
 {
    float us;				//上次输出控制信号
   float es;				//上次采样误差信号
   float es2 = 0;			//上次的上次的采样误差信号
   uint32 nj;				//采样转速信号
   float u;				//此次输出控制信号
   float e;				//此次采样误差信号
   p_arg = p_arg;
   PWMInit();			//PWM初始化
   while(1)
  {
    nj=IOPIN>>16;
    nb=(float)nj/10;		//采样反馈转速
    e=n-nb;
	u=us+q0*e+q1*es+q2*es2;	//PID处理
	if(u>=Umax)
	u=Umax;
	es2=es;
	es=e;
	us=u;
    OSMboxPost(Conbox,(void*)&u);  //发送处理后的信号
	OSTimeDlyHMSM(0,0,0,30);
   }
} 
/******************************************************************************
** 函数名称: Task2_Task
** 功能描述: 根据控制信号输出PWM波
******************************************************************************/
 void  Task2(void *p_arg)
 {
     uint8 err;
    float *nh;
    p_arg = p_arg;
    while(1)
   {
   nh=(float*)OSMboxPend(Conbox,0,&err);
    if(*nh>=Umax-0.5)
   {
   PWMMR0 = 2765;
    PWMMR1=  2764;
	PWMLER = 0x03;
	}
	else
   {
   PWMMR0 = 2765;
    PWMMR1=(uint32)(*nh/Umax*2765);
	PWMLER = 0x03;
    }			                             
}
 }
 void Delay(uint8 n)		  //延时函数
 {
   uint8 i;
  for(i=1;i<=n;i++);
 }
/******************************************************************************
** 函数名称: Task3_Task
** 功能描述: 定时采样输入的转速要求(0832采样)
******************************************************************************/
 void Task3(void *p_arg)
 {
     uint8 ch,i,flag=0;
    p_arg=p_arg;
    ch=0;
    IOCLR=ADC_CS;
    IOCLR=ADC_DI;//片选,DO为高阻态
    for(i=0;i<10;i++)
    {
   ;}
	IOCLR=ADC_CLK;
     Delay(4);
     IOSET=ADC_DI; 
     IOSET=ADC_CLK; 
     Delay(4);     //第一个脉冲,起始位 
     IOCLR=ADC_CLK; 
     Delay(4); 
     IOSET=ADC_DI; 
     IOSET=ADC_CLK;
     Delay(4);     //第二个脉冲,DI=1表示双通道单极性输入
     IOCLR=ADC_CLK;
     Delay(4);
	 IOSET=ADC_DI; 
     IOSET=ADC_CLK;
     Delay(4);     
评论 4
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值