CANopen协议在伺服电机控制系统中的实现

发布者:GHR2596最新更新时间:2006-07-12 来源: 单片机及嵌入式系统应用关键字:报文  伺服  缓冲器 手机看文章 扫描二维码
随时随地手机看文章

基于现场总线的网络技术的研究是自动化领域发展的一个热点,CANopen协议是目前流行于欧洲的基于CAN总线应用层的标准协议,对工程设计者来说,研究现场总线的核心任务就是对控制节点进行开发,本文就是通过实现伺服电机控制模块的CANopen为协议,说明一个基于CANopen协议的控制网络的组态。

伺服电机控制器在自动控制领域里有着广泛的应用,如纺织机械和印刷机等,为了得到理想的速控效果,伺服电机模块除了要在分辨率、线性程度以及转换速率上达到一定的要求外,还应具有良好的在线可控性和实时在线状态检测功能,为此,利用CAN总线高层通信协议CANopen,结合陕西省教育厅“并条机自调匀整”项目对伺服电机控制模块参数的要求,开发了一个具有硬件可重用性、软件可重配置特点的伺服电机控制模块。

1 CANopen协议概述[1-2]

CANopen协议是由CiA协会针对CAN协议的不完整性而定义出的一个更高层次的协议——应用层协议。一个CANopen设备模块可分为3部分,如图1所示,通信接口和协议软件用于提供在总线上收发通信对象的服务,不同CANopen设备间的通信是通过交换通信对象来完成的。这一部分直接面向CAN控制器进行操作,对象字典描述了设备使用的所有数据类型、通信对象和应用对象,对象字典位于通信程序和应用程序之间,用于向应用程序提供接口,应用程序对对象字典进行操作,即可实现CANopen通信。它包括功能部分和通信部分,通信部分通过对对象字典进行操作实现CANopen通信,而功能部分则根据应用要求来实现。

在CANopen网络系统中每个节点都有唯一的一个对象字典,而且每个节点的对象字典都具有相同的结构,但具体的内容要根据不同的设备而定,包含了描述该设备及其网络行为的所有参数,CANopen协议还定义了4种报文(通信对象),用于对不同作用的信息进行处理,分别为管理报文(NMT)、服务数据对象(SDO),过程数据对象(PDO)和预定义报文或特殊功能对象。具体的CANopen协议内容可参考相关文档。

2 伺服电机模块的硬件实现

伺服电机模块应用Microchip公司生产的带有CAN总线功能模块的主频为40M赫兹的PIC18F258单片机进行控制[3]。根据并条机自调匀整系统对伺服电机的要求(9V-3000r/min,即3mV-1r/min),以及从总线上以1ms为周期发送来的D/A转速控制数据,使用ADI公司的12位AD7243芯片进行D/A转换,它具有300K赫兹转换速率,3种可选择的输出电压,分别是0~+10V、0~+5V和-5~+5V,采用串行端口通信。

图2为硬件电路简图,根据系统需求,设置AD7243电压输出为±5V,将AD7243芯片的ROFS引脚与REFIN引脚相连实现,在AD7243的输出端接有OP07运算放大器,用于调整输出电压到±10V,以控制电机正反方向和调节转速,图中继电器FDLL4148用于控制电机的启动和停止,光耦TL521用于对伺服电机状态采集时的隔离器,为实时了解伺服电机运行状态,根据CANopen协议分别设计了用于指示系统当前状态和错误的LED(绿色和红色)指示灯。J1为与伺服控制器的接口插件。

图2中,在OP07上接有调节零输出偏置电压的可调电位器R3;用ADuM1100高速数字隔离器代替传统的光电耦合器,以降低功耗,提供精确的信号,MCP2551是一种可容错的高速CAN收发器,具有差分发射和接收能力,可将许多节点与同一网络相连接并采用非屏蔽线部署网络,从而降低系统成本。

3 伺服电机模块的CANopen协议实现

(1)CANopen协议实现

伺服电机模块在CANopen网络中作为从节点发挥作用,完成属于自己范围内的特定任务,进行实时数据传输,并对其负责的底层设备进行数据采集和控制,在实现CANopen协议之前,必须先了解它在网络中的具体功能:通过CAN总线接收控制伺服电机的数据(包括转速控制、启动和停止),采样伺服Ready信号和电机当前状态回送到CAN总线。

CANopen协议的核心内容是对象字典,完成各种机器CANopen协议通信的实质是在对象字典的基础上进行操作,通过映射的关系实现对各种报文数据的处理,根据伺服电机模块的功能并结合CANopen协议各类报文的特征,定义了如表1和表2所列的属性。


表1和表2定义的SDO报文和PDO报文分别用于读/写对象字典和传送实时数据,PDO报文映射参数子索引的内容代表PDO报文中各字节的用途,比如:RxPDO报文映射参数子索引0x64110110L指对象字典索引0x6411和子索引0x01,占16位的数据内容,即控制电机转速数据,此外,系统还定义了一个接收NMT报文,用于实现主节点对从结点的组态;一个 Heartbeat(心跳)报文,以5000ms为周期发送,使主节点实时监测从节点状态并在发生错误时及时进行处理。

除了上述用于实现伺服电机模块预定义功能的报文外,还根据CANopen协议的指示灯规范设计了状态(绿色)和错误(红色)指示灯,通过定时器周期性地检查CAN总线状态寄存器和CANopen通信状态标志,设置指示灯的常亮、闪亮和闪烁等状态,可使用户直观地判断当前机器所处的状态,从而提高工作效率,具体的CANopen协议和指示灯规范可以参考相关文档[4]。

伺服电机控制模块的设计是基于CANopen协议对象字典的模块化设计,它可以方便地进行功能扩展,只须修改对象字典中报文映射参数,添加相应的功能模块即可实现。与以往的基于CAN数据传送协议相比,大大提出了系统效率,节约了有限的硬件资源,为功能的扩展和用途的延伸提供了方便。

(2)应用程序流程

伺服电机模块上电以后,根据CANopen协议从节点的性质,系统在进行完初始化参数配置后,发送Boot-up报文通知主节点已进入预操作(preoperational)状态,并在主循环中等待各种类型中断的到来,在预操作状态中,可接收主节点的SDO报文读/写对象字典。比如当无法使DA零点输出偏置电压达到标准值时,可以通过修改对象字典的电压偏置值相来进行调整。NMT报文也可在预操作状态中接收,用于改变节点状态,进入伺服电机模块实时传输PDO报文的操作(operational)状态,开始系统的正常工作,一旦系统进入预操作状态,就会以5000ms为周期发送Heartbeat报文使主节点实时监控伺服电机模块的状态,当从节点发生错误时主节点就可以立刻采取措施,实现实时在线监控的功能,图3为中断程序流程图。

(3)基于PIC18F258微控制器的邮箱动态分配的实现

邮箱动态分配的任务是在不固定某个邮箱具体特性的同时,实现对邮箱中报文作用的判断,通过邮箱的动态分配,可以节约系统资源,提高软件灵活性,便于今后系统扩展。

在系统初始化过程中,实现了邮箱的动态分配,具体方法是:PIC18F258微控制器具有2个接收缓冲器和6个接收滤波器,其中:接收缓冲器0对应于接收滤波器0和1;接收缓冲器1对应于接收滤波器2、3、4和5。通过定义常数标志数组_uCANRxHndls[i](0≤i≤5),依次将要接收的报文COB-ID定义到接收滤波器中,当产生CAN总线接收中断时,根据中断标志寄存器PIR3的Bit0(RXB0IF,接收缓冲器0中断标志位)和Bit1(RXB1IF,接收缓冲器1中断标志位)来判断产生中断的接收缓冲器。

当接收缓冲器0中断时,则有:

_uCAN_ret=*(_uCANRxHndls+(RXB0CON&0x01)) (1)

其中:_uCAN_ret为标识某报文接收中断数组常数标志;接收缓冲器0控制寄存器(RXB0CON)的Bit0为接收滤波器0、1的选择位。

接收缓冲器1中断时,则有:

_uCAN_ret=*(_CANRxHndls+(RXB1CON&0x07)) (2)

其中:接收缓冲器1控制寄存器(RXB1CON)的Bit2-Bit0为接收滤波器2、3、4和5的选择位。

通过式(1)和式(2)可得代表某种报文中断的数组常数标志,实现对接收报文类型的判断,完成邮箱动态分配和相应报文处理。

4 实验验证

为方便实现实验室监测,直观地观察伺服电机模块的工作状态,判断D/A转化的线性特征,使用LabView软件设计了PC监控面板[5],如图4所示。

图4中的amplitude和phase分别用于设置发送正弦波的幅度和相位,正弦波数据以占用两字节的形式发送,结合继电器1和2占用的一个字节组成3字节的TPDO报文,光耦1、2表示从RPDO报文接收到的数据状态,在此监控面板的基础上,使系统的调试更加方便。

在示波器上观察到的D/A输出波形如图5所示,因为D/A输出为瞬间波形,所以在示波器上看到的波形光线只有一部分。此外,由于LabView软件的限制,最高输出数据周期只能达到1ms,因此,在示波器上看到的波形有折线存在,每个转折点代表一个输出点,通过设置相位值来决定转折点的个数,即输出多少个数据来表示一个波形,例如图5中的相位为18,则会输出36个点来表示一个周期波形。将此D/A输出至伺服控制器即可实现对伺服电机的控制,这一点已在现场试验中得到验证。

5 结论

通过对并条机自调匀整系统的其他控制节点采用相同的方法进行CANopen协议开发,实现了网络化的控制系统。除了伺服电机外一个完整的控制系统还应有:主控模块如(DSP或单片机)、PLC模块和键盘显示模块等。和伺服电机模块一样,可将每个控制模块都作为一个节点进行开发。每个节点都有各自的节点ID,所接收和发射的数据在总线上进行交流,通过改变伺服电机控制的低速罗拉转速来调节牵伸倍数,从而达到自调匀整的目的。

自动控制系统的网络化,标准化是现代工业发展的一个必然趋势,将CAN总线应用层协议CANopen应用于该领域有着广阔的应用前景,本文通过将伺服电机控制模块做成符合CANopen协议的标准化装置,并应用于并条机自调匀整系统中,使其具有了即插即用和在线监控特性,增强了设备的可扩展性,提高了数据传输的可靠性。这种基于现场总线应用层标准的协议的开发和使用,对提高系统的工作效率,特别是对复杂系统的研制具有一定的指导意义。

关键字:报文  伺服  缓冲器 引用地址:CANopen协议在伺服电机控制系统中的实现

上一篇:基于MTD2009J的步进电机细分控制系统
下一篇:LCD在电机软起动器中的应用

推荐阅读最新更新时间:2024-03-30 21:21

一种以CNA/CANopen总线为基础的分布式高机动雷达伺服系统
    我公司运用目前欧美盛行的CAN总线技术和产品,为雷达伺服系统提供包括座车调平、天线方位、俯仰、折叠和极化等功能的全套的网络化控制解决方案。CAN 是Controller Area Network 的缩写,是ISO国际标准化的串行通信协议。CAN属于现场总线的范畴,它是一种有效支持分布式控制或实时控制的串行通信网络。较之目前许多RS-485基于R线构建的分布式控制系统而言, 基于CAN总线的分布式控制系统在以下方面具有明显的优越性:第一,网络各节点之间的数据通信实时性强;第二,缩短了开发周期;第三,已形成国际标准的现场总线;第四,最有前途的现场总线之一。  
[嵌入式]
泰克示波器在伺服数控行业的应用
随着生产自动化程度的提高,越来越多的机械设备和运动系统需要精确的速度和位置控制。在新设备的研发和现有设备的技术改造中,变频调速、伺服和数控系统被广泛应用。运动控制已经成为自动化领域的热点之一。 从控制原理上看,无论是简单的步进电机控制还是DC无刷或交流伺服电机控制,控制电路产生具有特殊规律的驱动脉冲,控制驱动器中的IGBT等器件产生电机的驱动信号。对于设计人员来说,验证控制算法产生的驱动脉冲是否满足控制要求是一项非常重要的工作。另外,IGBT的驱动信号必须满足同一桥臂不能短路和一定的死区时间间隔的要求。如果不检查这些问题,系统可能会烧毁。 控制板作为控制单元,需要与设备中的各种传感器和上位机进行通信。板卡中的各种I/O接口
[测试测量]
泰克示波器在<font color='red'>伺服</font>数控行业的应用
编写单片机程序为对串行口初始化并读出接收缓冲器的数据
题目:设fosc=11.0592MHz,试编写一段程序,其功能为对串行口初始化,使之工作于方式1,波特率为1200bps;并用查询串行口状态的方法,读出接收缓冲器的数据并回送到发送缓冲器。 答案: Baud= 12 smod=1 时,x=208=D0H smod=0 时,x=232=E8H main: mov scon,#01010000b mov tmod,#00100000b mov th1,#0d0h mov tl1,#0d0h clr ea mov pcon,#80h setb tr1 loop: jnb ri,
[单片机]
伺服电机的调试方法和注意事项
伺服电机(servo motor )是指在伺服系统中控制机械元件运转的发动机,是一种补助马达间接变速装置。 伺服电机可使控制速度,位置精度非常准确,可以将电压信号转化为转矩和转速以驱动控制对象。 伺服电机转子转速受输入信号控制,并能快速反应,在自动控制系统中,用作执行元件,且具有机电时间常数小、线性度高、始动电压等特性,可把所收到的电信号转换成电动机轴上的角位移或角速度输出。 今天与大家分享的就是伺服电机的调试方法和注意事项。 ①伺服电机的调试方法 ②伺服电机的注意事项 1、伺服电机油和水的保护 A:伺服电机可以用在会受水或油滴侵袭的场所,但是它不是全防水或防油的。因此, 伺服电机不应当放置或使用在水中或
[嵌入式]
<font color='red'>伺服</font>电机的调试方法和注意事项
伺服电机选型计算最简单方式_伺服电机的工作原理
    下图所示是一种采用功率运算放大器LM675制成的伺服电动机控制电路,电动机采用直流伺服电动机。从图可见,功率运算放大器LM675由15V供电,15V电压经RP1加到运算放大器LM675的同相输入端,LM675的输出电压加到伺服电动机的输入端。电动机上装有测速信号产生器,用于实时检测电动机的转速。实际上测速信号产生器是一种发电机,它输出的电压与转速成正比。测速信号产生器G输出的电压经分压电路后作为速度误差信号反馈到运算放大器的反相输入端。速度指令电位器RP1设定的电压值经R1.R2分压后加到运算放大器的同相输入端,相当于基准电压。   伺服电动机的控制原理图   伺服电动机用字母M表示伺服电动机,是驱动系统的动力
[工业控制]
以旋转变压器为测量元件的7M CNC伺服系统
1.软件部分 与7360系统的 伺服控制 一样,7M系统也是采用实时中断实现 伺服控制 的。与7360系统不同的是,7M系统的差补计算部分每8ms进行一次,计算出8ms内工作台的进给量 Dci,而位置控制部分则每4ms计算一次,将计算结果作为一个4ms的进给指令,经过计算机接口输出。位置控制部分的计算过程为: (1)跟随误差的计算。设上一个4ms开始时工作台的实际位置为DFi-1,从位置检测组件获得的上一个4ms内工作台实际位置增量为 DFi,那么本次4ms周期开始时工作台的实际位置为 (5 14) 设上一个4 ms结束时指令位置为Dci-1,那么,本次4 ms的指令位置为 (5 15) 因此,本周期的伺服系统跟随误差,或
[测试测量]
以旋转变压器为测量元件的7M CNC<font color='red'>伺服</font>系统
机器人伺服电机厂商,日本企业竟占据半壁江山
近期,2017世界机器人大会在北京亦创国际会展中心完美落幕,ABB、发那科、KUKA、安川、新松、哈工大机器人、广州数控、康力优蓝、优必选等国内外知名企业同台竞技。手术机器人、钢琴机器人、智能协作机器人、仿生水母、仿生手臂等让观众目不暇接。机器人的正常工作离不开伺服,机器人电动伺服驱动系统是利用各种电机产生的力矩和力,直接或间接地驱动机器人本体以获得机器人的各种运动的执行机构,通常由伺服电机以及伺服驱动器组成。工业升级让中国机器人电机厂商面临着机会和挑战,与欧美日先进厂商相比我们还有着差距,与非网小编将汇总盘点全世界主要的机器人伺服电机厂商,让我们一起看看机器人伺服电机行业的发展现状。 伺服电机概念解读 伺服电机(s
[机器人]
基于MSP430F149的变频伺服系统的设计
近年来,伺服系统的发展始终以稳定性、响应性与精度为发展主轴,这也是用户在使用过程中最为看重的几大因素。在机床伺服系统、机器人控制系统、雷达天线控制系统等场合大都由直流伺服电机和直流伺服控制器来完成控制。在这些控制领域中,主要以负载的位置或角度等为控制对象的伺服控制系统[1]。随着变频器技术的高速发展,在伺服系统中交流变频传动因其功率因数高、反应速度快、精度高、适合在恶劣环境中使用等优点得到了越来越广泛的应用。本文提出一种基于高性能单片机MSP430F149、变频器、变频电机组成的数字式变频伺服系统,并将数字PID算法引入到此系统中,使系统获得了良好的系统静、动态性能。   1变频伺服系统的功能   为达到变频伺服系统的运行可靠、良
[模拟电子]
基于MSP430F149的变频<font color='red'>伺服</font>系统的设计
小广播
添点儿料...
无论热点新闻、行业分析、技术干货……
最新工业控制文章
换一换 更多 相关热搜器件
电子工程世界版权所有 京B2-20211791 京ICP备10001474号-1 电信业务审批[2006]字第258号函 京公网安备 11010802033920号 Copyright © 2005-2024 EEWORLD.com.cn, Inc. All rights reserved