习水县豆油夏季

本文针对伺服电机远程控制接线复杂性、单一性、不稳定性等问题，提出采用开放式通信协议DS 01、驱动子协议DSP402实现伺服机电控制的新方法。

前 言

CANopen是一种架构在控制局域网路（CAN）上的高层通讯协议，包括通讯子协议及装备子协定常在嵌入式系统中使用，也是工业控制常用到的一种现场总线。CANopen实现了OSI模型中的网络层以上（包括网络层）的协定。CANopen标准包括寻址方案、数个小的通讯子协定及由设备子协议所定义的应用层。CANopen支援网络管理、装备监控及节点间的通讯，其中包括一个简易的传输层，可处理资料的分段传送及其组合。一般而言数据链结层及物理层会用CAN来实作。除CANopen外，也有其他的通讯协定（如EtherCAT）实作CANopen的设备子协定。

CANopen由非营利组织CiA进行标准的起草及审核工作，基本的CANopen设备及通讯子协议定义在CiA 01中。针对个别设备的子协议以CiA 01为基础再进行扩充。如针对I/O模组的CiA401及针对运动控制的CiA402。

针对伺服电机远程控制接线复杂、控制单一、可靠性不高等问题，提出利用CANopen通信协议、驱动子协议实现伺服电机控制的新方法。分析CANopen协议的对象字典和报文格式，详细介绍了CANopen伺服控制状态机各步骤的转换和实现CANopen协议下PP、PV、HM 钟伺服控制模式的报文设置。利用CAN卡和伺服驱动设备以及伺服驱动设备和PC机构建了实验平台，在上位机界面通过报文设置成功实现了基于CANopen协议的伺服机电的PP、PV、HM的三种模式的控制。实脸结果表明利用协议的报文设置控制电机简单易操作，通讯数据快速、可靠，用户通过上位机可以很好的实现对伺服机电的监控。

系统架构搭建

全部控制系统由PC机、CANopen上位机、USBCAN适配器、伺服驱动装备构成。CANopen通讯部份由DS 01协议实现，伺服控制部分由DSP402协议实现伺服驱动设备作为的从节点，具有CANopen通讯功能，负责机电的电流、转速、位置等控制对象，它通过通讯接口与总线相连，将信息传送给计算机的上位机界面；上位机界面则根据从站的反馈信息通过USBCAN适配器对伺服驱动设备实现控制。如图1所示为开放式通讯协议的伺服控制系统整体架构图。

图1 开放式通讯协议伺服控制系统整体架构图

开放式通讯协议伺服控制原理

1 CANopen通讯设备模型

CANopen的设备模型分为以下 个部份：通信单元、对象字典、运用进程。用户可以通过该模型对功能完全不同的装备进行描写。

CANopen的核心概念是对象字典，对象字典包含描写这个装备和它的网络行动的所有参数，运用单元和通信单元都可以问这个参数列表。对象字典中的参数通过一个16位索引和位子索引进行辨认和定位。

通讯部份由CAN收发器、CAN控制器和CANopen协议栈组成协议栈中定义了实现通讯的通讯对象：NMT（网络管理报文）、PDO（过程数据）SDO（服务数据对象）预定义报文或者特殊能对象（含同步报文、紧急报文、时间标记对象等）通讯的所有内容和功能由这些通信对象描写，所有设备之间通信也通过这些通信对象完成。其中NMT用于主站对从站进行状态管理和从站应对本身所处的通讯状态，SDO用于主站对从站的对象字典进行配置和监控。PDO用来传输高速、小型数据。而特殊功能对象则用于同步网络中的通讯对象（通常为PDO）的方法。应用部份是对设备的基本功能的定义和描写，它是连接装备与主站上位机的纽带，其核心功能是通过访问装备的对象字典对装备进行参数配置、状态控制和监控，并高速传输装备的过程数据信息。

2 伺服控制模式

CANopen驱动及运动控制装备子协议DSP402对特性的描述要求非常准确，它不但定义了驱动器的运行模式，还定义了用于控制驱动器的状态机。驱动器状态机通过对象字典中的控制字6040来控制，并通过状态字6041来读取驱动器的状态。控制状态机如图2所示。

图2 控制状态机图

状态机可以分成以下 个部份：PowerDisabled(主电关闭)、PowerEbabled(主电打开)和Fault。所有状态在发生报警后均进入“Fault”在上电后，驱动器完成初始化，然后再进入SWUTCH_ON_DISABLED状态，在该状态，可以进行CAN通讯，可以对驱动器进行配置。此主电仍然关闭，机电没有被励磁。经过StateTransition（状态传输）2, ,4后，进入OPERATIONENABle此时，主电已开启，驱动器根据配置的工作模式控制机电。StateTransition（状态传输）9完成关闭电路主电。一旦驱动器产生报警，驱动器的状态都进入FAULT。

PP模式（简表位置模式）是典型的定位模式，可通过单步设定与连续设定两种方式控制电机运行到目标位置。PV模式（简表速度模式）是速度控制模式，HM（回零模式）提供多种达到起始位置的方法。

系统软硬件设计

1系统硬件设计

本文设计采用USBCAN和伺服驱动装备和PC机来搭建硬件平台。伺服驱动控制芯片采用的是DSP的芯片。

系统硬件搭建按以下步骤进行。首先在TI的开发环境中配置好的相干参数，并建立DS 01工程项目，完成CANopen协议通信程序的调试运行。项目调试成功之后下载到驱动器中，在上位机界面中设置报文，测试SDO、PDO、NMT等通讯对象。测试结果正确则系统硬件搭建完成。

2系统软件设计

全部伺服控制的软件设计在CCS中建立，主要包括永磁同步电机的闭环控制程序和CANopen协议找的实现两大部分。如图 所示为软件设计流程图。 图 软件设计流程图 初始化部分程序主要完成DSP系统的初始化以及CANopen通讯的初始化。

初始化主要完成的工作如下：

初始化相干变量，使能全局中断，进人伺服电机编码器霍尔传感器反馈UVW三路信号来判断电机初始电角度位置。

初始化通讯的主要完成的工作如下：

设置从站节点地址和CAN通信波特率，初始化各通对象，完成各路的预定义映射，最后进入通信处理程序。

伺服控制报文设置

CANopen报文结构由11位的COB-ID以及最多8字节的数据域构成。在上位机界面中通过NMT报文设置控制从站进入预作状态或运行状态，再通过SDO报文设置伺服控制的各个参数（速度、位置等）以及状态机的各个状态可以使机电按照不同控制模式运转起来，最后通过将电机的当前参数映照到PDO中，读取PDO报文的值得到电机当前值，将其与设置值比较得到控制结果的正确性。控制报文全部由SDO实现。

以下为PP模式控制、PV模式控制和HM模式控制报文列表：

1.PP模式控制报文列表

2.PV模式控制报文列表

.HM模式报文列表

以上3种控制模式报文操作都是首先设置伺服控制模式，然后根据当前模式依次输入相关的目标控制值（如位置、速度、回零方式等），最后依照状态机步骤使用6040h控制电机启动与停止。

仿真实验

本系统的上位机界面由USBCAN的上位机界面及机电的监控界面两部份构成，其中USBCAN的上位机界面作为CANopen报文数据监控界面，机电的监控界面用VB2008开发。在上位机界面中通讯波特率选用1Mbps伺服电机Node-ID设置为1，心跳周期为1s，TPDO发送周期为100ms，同时设置好机电电流环、位置环、速度环的参数，将设置的报文依次输入上位机界面的SDO控制，机电启动并运行到报文中的设定值，机电手动遥控器显示值与设定值一致，同时上位机界面中报文显示值也与设定值一致，成功实现了伺服控制的控制。

1PP模式

电机监控界面中位置控制曲线如下图4所示：

图4 机电位置控制曲线

在上位机界面中设置好报文值，电机启动。电机先加速运行，达到设定的目标速度值后开始匀速运行，直至达到设定的目标位置值就不再变化。上位机进程数据与电机监控曲线变化一致。如果需要改变电机的位置值，在上位机界面中顺次输人新的控制报文，电机会根据设定值正转或反转，继续运行到新的位置。

2PV模式

机电首先加速到设定的目标速度值，然后依照设疋值勾速运打。如果需要改变运行的速度，同样可在上位机界面中输人新的速度值，加速时的变化如上所述。减速控制时，电机减速直至速度为则停止。如图5所示为上位机数据变化与机电监控曲线变化一致速度控制曲线。

图5 电机速度控制曲线图

HM模式

电机先加速到设定速度，然后寻觅原点位置，找到原点后，机电回零，减速直至这时候分别在上位机界面以及机电的手动遥控器伺服电机中査看电机的当前位置值，都可以看到电机的当前设为说明电机回零操作完成。如图6所示为位置控制曲线图。

图6 位置控制曲线图

结 论

在实际应用应用进程中，本文所设计的系统运行可靠，数据准确易分析，机先加速运行，到达设定的目标速度值后开始匀速实时性好，协议栈程序易植入。该方法可以扩展适用于多电机控制系统，而且的CANopen通信协议栈适用于所有装备，在工程运用应用领域非常广泛。临沂白癜风医院咋样

什么药医治胸闷气短

3诺血糖仪和强生血糖仪哪个好

老人血栓吃通心络可以吗

用什么药能阴阳双补

骨折吃什么营养品好