【期刊】基于DSP的伺服运动控制器研究与开发.pdf
《【期刊】基于DSP的伺服运动控制器研究与开发.pdf》由会员分享,可在线阅读,更多相关《【期刊】基于DSP的伺服运动控制器研究与开发.pdf(5页珍藏版)》请在得力文库 - 分享文档赚钱的网站上搜索。
1、自动化技术与应用2 0 0 8 年第2 7 卷第6 期T 业手空韦U 与应用基于DSP 的伺服运动控制器研究与开发范庆彬(哈尔滨理工大学后勤集团,黑龙江哈尔滨15 0 0 8 0)摘要:根据开放式运动控制的要求,以D S P 和C P L D 为核心设计了能实现高速、高精度插补功能的开放式伺服电机运动控制器。介绍了控制器硬件构成、工作原理。控制器通过P C I 或U S B 总线与上位机通讯,位置环采用速度、加速度前馈P I D 控制算法。实验和仿真结果表明控制器控制实时性好,跟随误差小,加工精度高。关键词:开放式运动控制器;D S P C P L D中图分类号:T P 2 4 2 2文献标识
2、码:B文章编号:1 0 0 3 7 2 4 1(2 0 0 8)0 6 一0 0 3 2 0 3T h eD e v e l o p m e n to faD S P-B a s e dS e r v oM o t i o nC o n t r o l l e rF A NQ i n g-b i n(S e r v i c eG r o u p,H a r b i nU n i v e r s i t yo fS c i e n c ea n dT e c h n o l o g y H a r b i n1 5 0 0 8 0C h i n a)A b s t r a c t:T h i s
3、p a p e rp r e s e n t sa no p e nc o n t r o l l e rb a s e do nD S Pa n dC P L D T h ec o n t r o l l e rc a np e r f o r mh i g hs p e e da n dh i g ha c c u r a c yi n t e r p o l a t i o n T h eh a r d w a r ea n dt h ep r i n c i p l eo ft h em o t i o nc o n t r o l l e ra r ei n t r o d u c
4、e d T h ec o n t r o l l e rc o m m u n i-c a t ew i t ht h eu p p e rc o m p u t e rt h r o u g hP C Io rU S Bb u sT h ec o n t r o la l g o r i t h mo ft h ep o s i t i o nl o o pi st h eP I Dl a ww i t hs p e e da n da c c e l e r a t i o nf e e d f o r w a r d E x p e r i m e n t sa n ds i m u l
5、 a t i o nr e s u l t sa r eg i v e n K e y w o r d s:O p e nm o t i o nc o n t r o l l e r;D S P;C P L D1引言运动控制器是数控机床、机器人等一类机电一体化设备中常用的核心运动控制部件。现代数控技术对运动控制系统的开放性、实时性、加工速度和精确度等性能指标提出了越来越高的要求。随着集成电路技术,微电子技术、计算机技术不断发展,运动控制器已经从以单片机、微处理器和专用芯片作为核心的运动控制器发展到基于P C 机平台的以数字信号处理器(D S P)和复杂可编程逻辑器件(CPLD)作为核心处理器的
6、协处理架构的开放式运动控制器。这种将PC 机的信息处理能力和开放式的特点与运动控制器很强的运动轨迹控制能力有机地结合在一起,具有信息处理能力强、开放程度高、运动轨迹控制准确和通用性好的特点。这种模式在一个统一的人机对话平台上,通过DSP 算法和C P L D 配置进行适当的调整来实现不同的硬件功能模块,可以方便地和多种类型的驱动器进行连接。因此现收稿日期:200 8 03 12在基于PC 的新一代运动控制器成为控制系统的主流和发展方向【2 1。本文开发的开放式运动控制器以PC 机为平台,完成坐标变换、轨迹规划、粗插补运算等控制指令的设置和发送,同时可以实时显示当前伺服系统的运动位置、速度和电机
7、状态等参数。运动控制器以D S P 芯片作为核心处理器,完成数据处理和控制算法,进行保护中断的处理,通过P C I 或U S B 总线与P C 机实时通讯。C P L D 芯片作为协处理器完成编码信号的采集,鉴相处理,对脉冲和模拟量进行配置和输出,把D S P 处理过的控制数据经过内部转换送到外部设备,并管理D S P 和各种外部设备的接口。该运动控制器可以完成非匀速比同步运动控制,支持N U R B S 插补,并提供了丰富的动态链接库函数。2运动控制器工作原理和硬件构成该控制器可实现四路编码器反馈和电机控制,其核万方数据工业 空带U 与应用自动化技术与应用2 0 0 8 年第27 卷第6 期
8、心是T I 公司的T M S 3 2 0 L F 2 4 0 7 数字信号处理芯片和A L T E R A 公司的M A X7 0 0 0 S 系列C P L D 器件E P M 7 1 2 8 S L C 8 4。控制器的硬件结构如图1 所示。D S P完成与上位机的实时通讯,对伺服电机速度和位置的精确控制,电机状态监测和外部信号检测等功能。双口S R A M(D U A L P O R TS T A T I CR A M)不仅提供控制器与上位机的通讯接口,而且还为运动轨迹控制提供了足够的缓冲区。由于一片D S P 只提供两组正交编码脉冲(Q E P)电路,对于多于两个电机的控制器,若用多片
9、D S P 不仅会造成D S P 资源的浪费,而且还会增加由于协调D S P 之间的工作而产生的难度,因此这里我们用C P L D 来提供另外两组正交编码脉冲电路,对速度、位置进行采样,同时用C P L D 提供高速稳定的其它逻辑控制电路。P 上C I 毫噬线L 牛剿T M S 3 璐2 0 P L F 2 4 0,睦雪R 一篇因匡畔运动控制器由基板和接口卡组成,集成了D S P 核心电路,通信电路,C P L D 译码、中断、正交编码处理电路,编码器信号处理电路,电压转换电路,光电隔离电路等。运行过程中,P C 机把粗插补的数据通过I S P-1 5 8 1 芯片传递给D S P 进行时间分
10、割精插补。在每一个伺服周期中,C P L D 器件和D S P 各处理两路反馈的正交编码信号进而获取实时位置和速度,D S P 计算出理论插补位置与实际位置的偏差,基于速度和加速度前馈进行P I D 调节,计算获得速度控制量,产生的输出信号经D A C 7 6 2 5 进行数模转换及放大电路放大后将模拟电压发送至伺服驱动器以控制电机。D S P 两个事件管理模块中的正交编码脉冲(Q E P)电路可以实现对两对正交编码信号的四倍频和方向检测,其定时器工作在增减计数模式,依据电机运行情况进行计数。根据不同伺服周期定时器内数值的变化,可以计算获得电机的实际位置,由M T 测速法可求得其运行速度。另外
11、两个电机的反馈信号由E P M 7l2 8 进行处理,D S P 与之通讯以获取电机运行信息。扩展4 个3 2位寄存器用来存储电机当前位置,通过实时从计数器读取每个伺服周期走过的脉冲数与之累加实现。每隔一定的伺服周期,将4 个1 6 位的计数器赋初值3 2 0 0 0 使之重新计数。2 1C P L D 处理电路C P L D 主要包括正交编码检测逻辑电路,D S P 地址译码电路和计数器及中断逻辑四个部分,它对两个正交编码输入四倍频后进行计数,反馈给D S P。正交编码脉冲电路的方向检测逻辑决定了输入序列中的哪一个是先导序列,接着就产生方向信号作为计数器的计数方向输入。如果Q E P1 是先
12、导序列,则所选的定时器增计数;如果Q E P 2 是先导序列,则所选的计数器减计数。正交编码脉冲电路对输入的两列脉冲的两个边沿都进行计数,因此,由它所产生的时钟频率是每个输入脉冲序列频率的四倍。中断逻辑,限位和报警等信号产生时向D S P 申请中断。每个轴的正负限位信号、归零信号和报警信号,四个轴共计1 6 个信号,这些信号相或,只要有一个信号产生时就产生一个上升沿信号,此上升沿触发D S P 中断,D S P 以查询方式判断是哪个信号产生的中断。2 2 控制卡通讯及接口早期P C 机通过I S A 总线实现对电机的控制,但响应速度慢,实时性差,后来的P C I 局部总线,解决了I S A的传
13、输速度慢等问题。近几年通用串行总线USB(U n i v e r s a lS e r i a lB u s)以其较快的传输速率和支持热插拔等诸多优点而受到用户的广泛受青睐。得到了许多硬件和软件厂商的支持。U S B2 0 接口的最高传输速率由1 2 M b s 提高到了4 8 0 M b s,能够更好地支持数据实时传输。把U S B 引入运动控制器,实现了运动控制器的热插拔,解决了计算机接口资源有限等问题,满足了多轴运动控制卡对数据实时通讯的需要【3 1。为提高运动控制器硬件上的开放性,开发了通用的接口卡,辅助完成基板与外部的通讯。除了进行反馈信号等的必要传输外,还提供了电机的限位、回零、报
14、警、伺服使能等信号和通用I 0 各8 路。为防止外界信号干扰,保证控制器的可靠性和安全性,输入输出信号都经由T L P 5 21进行光电隔离。3速度、加速度前馈P ID 控制算法本控制器采用典型的三环调节,其中速度调节器和电流调节器的功能由伺服电机驱动器完成,电流环用来万方数据自动化技术与应用2 0 0 8 年第2 7 卷第6 期工业控制与应用提高系统的动态响应指标,增强系统抗干扰能力;速度环用于调节伺服电机的转速。位置闭环调节原理框图如图2 所示,它包括位置P I D 调节和速度、加速度前馈,由运动控制器底层程序完成,用于实现精确定位,回零等,输出饱和控制可保证输出电压不会超过设定范围。图2
15、伺服电机位置环系统结构图位置环的计算公式为:色=雌甜L 一(k(1)以=毛+(E 一k+l 邑K,2 5 6+V+4(2)、B其中E 为第n 个采样时刻的位置误差,匕锕为第n个采样时刻的目标位置,乞删为第n 个采样时刻的实,一、际位置;U。为位置环输出速度指令电压;I E。I 为第nn个采样时刻的累积误差值,V 为当前目标速度,K 谛为速度前馈增益;A 为当前目标加速度IK 西为加速度前馈增益;K。、匠,钇分别为比例、微分和积分增益。4M a t l a b 仿真及结果分析基于K L D-2 0 0 二维数控平台进行仿真。平台由两个P a n a s o n i c 公司的M S M A 0
16、1 2 A1 E 伺服电机及配套的M S D A 0 1 3 A 1 A 驱动器进行控制。电机最高转速为3 0 0 0 R P M,功率1 0 0 W,增量式编码器,2 5 0 0 P r,丝杠导程为4 m m r。取K,=1 0 0,墨=1 2、髟=2 进行仿真。Y轴电机速度曲线与余弦曲线类似,跟随误差曲线如图3所示。无前馈情况下电机跟随误差从开始的63 个脉冲在0 1 3 7 秒后上升到1 1 4 个脉冲,随后作类似余弦曲线的变化。引入前馈后,跟随误差从开始的6 3 个脉冲迅速上升到1 0 9 个脉冲,然后逐渐下降,在大约0 2 秒后稳定在2 个脉冲之间。可见,速度和加速度前馈大大减小了系
17、统的跟随误差。利用自己开发的运动控制器对数控平台反复进行控制实验,效果良好。梯形曲线控制实验中,设定加速度为l O r e v s 2,目标速度3 0 0 R P M,位移1 2 0 r a m。到达目标速度后,驱动器显示的电机速度波动范围在2 R P M 之间。利用V C 的O n T i m e r()函数实时获取位置信息并进行显示,可以看出,到位后的最大超调量约为5 1 0 个脉冲,稳态误差在-t-2 个脉冲之内,小于l m m。”图3跟随误差比较结束语本运动控制采用基于D S P 和C P L D 的硬件方案充分发挥了D S P 芯片实时高效的处理能力,系统设计合理,可以实现变传动比的
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 期刊 基于 DSP 伺服 运动 控制器 研究 开发
限制150内