微波EDA网,见证研发工程师的成长!
首页 > 应用设计 > 机器人技术 > 精密运动控制器LM628的应用设计

精密运动控制器LM628的应用设计

时间:06-20 来源:互联网 点击:
引言

神经网络技术是自动控制方法发展的重要方向之一,目前已广泛地应用于过程控制、机器人控制、生产制造、模式识别等领域。由于神经网络理论的计算量较大,对硬件的要求较高,神经网络理论系统一般十分昂贵。近年来随着集成电路飞速发展,基于神经网络理论的控制系统可以用微处理器和专用的大规模集成电路来实现。这样就大大降低了系统的成本。大规模集成芯片LM628是美国国家半导体公司生产的专用精密运动控制器,具有16位的可编程数字PID调节器,可经增量码盘反馈构成位置闭环,并能对位置误差实行PID运算。利用LM628和微处理器可实现低成本、高精度神经元PID伺服系统。

LM628主要特点如下:32bit位置、速度、加速度寄存器;16bit的可编程数字化PID调节器;可编程微分采样周期;8bit或12bit DAC输出;8bit PWM输出;内部梯形速度特性产生器;在运动期间速度、目标位置和滤波器参数可以改变;具有位置和速度两种操作模式;实时可编程的中断;8bit异步并行接口;用于积分增量编码器标准脉冲输入接口。

表1 LM628引脚说明
引脚号引脚名称功能
1Index(IN)积分增量编码器标准脉冲输入选择端,如该引脚不用必须保持为高
2A编码器信号输入
3B编码器信号输入
4~11D7~D0用于与微处理器接口的双向数据总线.
12CS片选端,低有效
13RD读许,低有效
14GND电源地
15WR写许,低有效
16PS端口选择,低为命令状态,高为数据状态
17HI中断输出
18~25DAC7~DAC0输出端口
26CLK系统时钟
27RST复位端,低有效
28VDD电源

内部结构及工作机理

  

LM628为28脚双列直插封装形式,引脚功能如表1所示,图1所示为其内部功能框图。

LM628通过8bit并行I/O口与微处理器进行数据交换,微处理器可以以命令的形式对LM628的梯形速度特性和PID数字滤波器进行参数设定。用于检测电机旋转位置的增量编码器的输出信号通过编码器输入接口送入LM628,在LM628中与设定的位置信号相减,形成位置误差信号,该信号送入PID数字滤波器进行处理后形成控制信号,通过8bitDAC并行接口以数字化的形式输出,然后就可以通过数模转换器和功率放大电路驱动伺服电机完成精密的运动。

微处理器通过命令的方式对LM628进行控制和参数设定和读取,在这些命令中,一般可分为两大类,一类只有命令代码,而另一类在命令代码后还要加上相应的数据代码(例如:设定的参数值)。LM628的命令集如表2所示。

LM628主要参数为:最高工作电压7V;最大功耗为605mW;工作温度范围是-40℃~+85℃;电源电压为:4.5~5.5V;存储温度范围为-60℃~+150℃。

表2 LM628命令集
命令类型说明对应的16进制数数据字节数
RESET初始化复位LM628000
PORT8初始化选择8bit输出050
DFH初始化定义原始位置020
SIP中断设定标志位置030
LPEI中断错误时中断1B2
LPES中断错误时停止1A2
SBPA中断设置绝对断电204
SBPA中断设置相对断电214
MSKI中断屏蔽中断1C2
RSTI中断复位中断1D2
LFIL滤波器装载轨迹线1F2~10
UDF滤波器更新滤波器040
LTRJ轨迹装载轨迹线1F2~14
STT轨迹开始运动010
RDSTAT报告读状态字节1
RDSIGS报告读信号寄存器0C2
RDIP报告读标志位置094
RDDP报告读期望位置084
RDRP报告读实时位置0A4
RDDV报告读期望速度074
RDRV报告读实时速度0B2
RDSUM报告读积分和0D2


LM628在神经元PID伺服系统中的应用

以89C52单片机为核心的伺服系统如图2所示,在该系统中89C52实现用户的接口,如显示、键盘等,并完成神经元的学习算法及在线调整LM628的参数。LM628作为伺服控制调节器,接收89C52单片机传送的控制指令及位置、速度、加速度三个运动参数和数字滤波器的参数kp,ki,kd,n'(微分采样周期),同时LM628对码盘输出的信号进行处理,获得位置信号,经数字PID运算后,由DAC端口以8bit方式输出,经数模转换器DAC0800转换为模拟信号,再经LM12CL组成的放大电路输出,用于驱动电动机完成精密的运动。LM628的输出与误差的关系式如下式所示。

     

  

上式中,U(n)为第n个采样周期的控制输出;e(n)为第n个采样周期的位置误差;n为正常采样周期;n'为微分采样周期;kp为比例增益;ki为积分比例增益;kd为微分比例增益。

比例增益kp提供了一个与位置误差成正比的输出,积分比例增益ki提供了随时间增长的输出,因此保证了静态位置误差为0。微分比例增益kd提供了与位置变化率成正比的输出,起到了超前控制的作用,减小了系统的超调,保证了系统的动态特性良好。式(1)与神经元PID算法的表达形式一致,因此在LM628中实现了神经元的状态量变换,状态量加权求和的功能,也就是实现了神经元PID伺服系统。

Copyright © 2017-2020 微波EDA网 版权所有

网站地图

Top