基于CPLD的开放式四轴运动控制器的设计.docx

基于CPLD的开放式四轴运动控制器的设计摘要：一种基于PC机的开放式四轴运动控制平台的软、硬件组成及设计方法。采用CPLD简化了平台硬件构造，利用PC机的资源实现了“软运动控制功能。系统具有构造开放、使用方便、本钱低廉、性能可靠等特点，可以灵敏地实现定制应用。关键词：开放式系统运动控制器CPLD作为运动控制的核心部件，运动控制器普遍采用16位或者32位微控制器，其灵敏的系统集成方式和高速的指令执行速度进步了运动控制性能、改善了控制系统的精度、增强了系统构成的灵敏性。如DeltaTau公司的PMAC系列、MEI公司的XMP系列的产品，均采用了高速数据信号处理器DSP和现场可编程门阵列FPGA技术，一般可以控制18个轴。这些基于PC机总线的运行控制器，固然因采用高性能微处理器在信息处理速度方面有较大的进步，并在实际应用中提供了灵敏的接口，但在使用以及系统集成的时候，仍然有很多不便，如价格比拟高、应用非常复杂等。并且在构造上是封闭的，只能针对某一类型的应用，控制策略单一，很难同时知足控制系统在多种应用场合中的要求，实际定制应用。过去，受计算机处理才能的限制，高性能的运动控制技术需要在板处理器如单片机或者DSP上实现，一般PC机中的微处理器很难同时完成如轨迹插补运算和伺服控制运算等任务。目前PC机微处理器已经采用了更先进的工艺技术，信息处理才能明显进步，可以知足高速实时运动控制的要求，硬件支持才能大在增强，并且PC机良好的软件开发环境使构造开放式运动控制平台成为功可能。本文提出了一种不采用在板处理器而以PC机微处理器为控制核心的开放式四轴运动控制器，该运动控制器采用ALTERA公司的复杂可编程门阵列CPLDEPF6016实现硬件治理功能，硬件的功能可以通过软件配置，而应用层的功能如运动轨迹规那么和伺服控制等均由PC机完成。1、系统硬件构造开放式四轴运动控制器的硬件构造如图1所示。其中，虚线框内的局部由ALTERA公司的复杂可编程门阵列EPF6016实现。FLEX6000系列器件EPF6016是ALTERA公司为大容量设计提供的一种低本钱可编程交织式门阵列，共有16000个可用门，1320个逻辑单元，117个I/O引脚，每个I/O引脚都有独立的三态输出使能控制。该器件采用OPEFLEX构造，能在最小的芯片尺寸上保持高性能和高布线率。器件的根本组成是逻辑单元LE。每个逻辑单元由一个4输入查找表、一个存放器以及作为进位链和级连链功能的专用通道。每十个逻辑单元组成一个逻辑阵列块LAB。器件采用SRAM构造，可以通过外部EEPROM或者控制器实如今线配置，能使设计者在设计初期以及设计测试经过中对设计作灵敏的修改，同时也可以通过在线重新配置来改变其内部功能。运动控制器的硬件功能编程由ALTERA公司提供的MAX+PLUSII开发系统支持，设计采用了原理图输入方式，设计和调试比拟直观、简便。该运动控制器的硬件构造分为以下几局部：1主机接口电路：运动控制器采用了ISA-AT总线接口，同时设计了PC-104接口。数据总线宽度为16位，接口功能在EPF6016内部实现，其中包括总线地址译码、数据和命令锁存、中断及复位等功能。2光电编码器接口电路：运动控制器接收四路光电编码器差分输入信号作为位置反应，最高输入频率为1MHz，输入的A、B相信号经过差动接收后，在EPF6016内部经过数字滤处理后进展倍频和辨向，产生的方向信号和脉冲信号进入16位加减计数器。系统软件可以计数而获得实际的位置变化。3模拟量输出电路：高性能的运动控制器应采用高分辨率的D/A转换器。为了保证模拟量控制信号的精度，并考虑到模拟量信号在线上传输引起的漂移和电压降落，运动控制器和伺服驱动器之间的模拟控制接口信号至少应有12位以上的精度。本文中的运动控制器采用了低本钱、小封装体积的双16位串行输入D/A转换器AD1866，构成双极性电压输出方式。在EPF6016内部设计了控制4路并发式并行/串行数据转换以及4路D/A地址选择电路，运动控制器的模拟量电压输出范围为±10V。4数字量输入输出电路：运动控制的所有I/O信号均采用光电隔离处理，考虑到I/O并关信号可能产生的信号抖动现象，对每一路I/O信号都进展了相应的数字滤波处理以消除噪声信号。控制器设计了40路I/O信号，其中包括16路专用输入信号、2中特殊开关输入信号用于坐标测量或者定位的接触式测头信号和急停开关信号，另外还设计了16路可编程通用I/O信号8路输入/8路输出。实际上，所有的I/O信号除个别信号具有独特的功能外，都是开放的，可以根据I/O信号除个别信号具有独特功能外，都是开放的，可以根据应用的特点设计详细的功能。5模拟量输入电路：对于一些控制场合，需要检测或者控制外部状态量的变化，运动控制器也设计了相应的单端或者差动式模拟量反应输入通道。系统采用MAXIM公司的8通道、12位转换精度、150kHz采样频率的A/D转换器MAX197。各模拟量通道可以独立编程选择输入范围：±10V、±5V、010V、05V，A/D转换器的转换基准采用内部基准。6可编程定时器：由于在开放式运动控制系统中，插被运算和伺服控制都由PC机完成，这两个控制任务通常不在一个任务循环中处理。一般而言，插补运算的周期要比伺服控制的周期长，因此两个任务需要占用不同的系统资源。由于插补运算通常占用PC机的定时中断资源，而伺服控制也是一个需要准确定时的任务，因此在EPF6016内部设计了可编程16位定时器。该定时器可采用不同的时钟源，定时范围为0300ms，最小分辨率为70ns，定时器产生的溢出动作可以向PC机申请中断。7同步工作电路：在运动控制系统中，各控制轴同步运行是一个很重要的要求，因此在EPF6016内部设计了同步控制电路的和专门的控制字，支持多块运动控制器控制输出同步刷新、反应计数值同步读取等操纵。8硬件看门狗电路：在运动控制器中采用了DALLAS公司的看门狗复位及电压监控芯片DS1232，以监测系统的软硬件运行情况。当系统软件运行死机的时候，看门狗电路产生信号复位系统，保证整个系统的可靠性。看门狗定时时间可以编程设置为300ms、600ms、1.2s。从硬件构造的组成特点可以看出，系统的组成核心是其有可重新配置特点的CPLDEPF6016，它实现了几乎所有外围电路治理功能，而其它的电路都属于标准的辅助电路。因此系统在构造上具有典型的开放性，这对实现软件的开放是一个很好的支持。2、运动控制器软件设计运动控制器的软件采用BorlandC+语言编写，可以按照库函数的方式调用。根据实时运动控制的特点硬件资源的构造，函数库分为两类：1控制运动控制器硬件操纵的函数库。包括针对运动控制器硬件根本操纵的函数，通过调用这些函数可以充分利用硬件资源，实现定制的应用。运动控制器上的各个硬件功能的存取操纵是通过一组读写控制命令实现的，每一个控制命令占用一个PC机I/O空间地址，对每一个地址分别进展读或者写操纵将产生不同的功能。硬件操纵函数库按照C+语言类的方式构造，每个命令都是以运动控制器硬件操纵类的公有成员函数形式存在。这些命令主要实现以下功能：控制光电编码器脉冲计数器，读取或者去除计数值；设置运动控制器的工作方式以及配置系统的各个硬件资源；开关量输入输出操纵，实现包括通用I/O和专用I/O的查询和设置、控制器硬件资源工作状态查询等功能；模拟量控制命令，用于控制D/A转换器和A/D转换器实现模拟量输出和模拟信号收集等。2定制应用算法函数库。根据实际应用的要求，以控制运动控制器硬件操纵的函数库为根底，可以有针对性地设计应用算法函数。本文以运动控制为例设计了针对运动控制的算法函数库，实现运动规划、伺服控制等功能。其它控制算法和功能也可以在此根底上进一步扩展。运动控制算法函数库的各命令也采用C+语言类的方式进展封装，控制算法类是运动控制器硬件操纵类的继承，调用和修改都特别方便，因此在构造上具有很好的开放性。在伺服运动控制算法上，控制器将当前规划的运动位置、进给速度送入伺服控制器与反应的实际位置进展比拟，得到位置跟踪误差，经过位置控制器后，送到D/A转换器，输出伺服驱动器的控制信号。位置控制算法可根据实际的要求采用多种控制策略。本文的运动控制器控制算法采用PID+速度前馈方式。通过调节各参数，这种控制算法能对大多数系统实现准确而稳定的控制。其控制构造如图2所示。伺服控制器输出计算公式为：其中，Un伺服控制器输出值；En第n个采样时刻的位置误差；Prarger采样时刻n的目的位置；Pactual采样时刻n的实际位置；Vtarget当前期望速度，单位为计数值/采样周期；B漂移补偿。3、系统应用及实验结果从运动控制器的软硬件构造可以看出，这种设计具有比拟好的开放性，便于软硬件方面进展功能扩展和重新配置，同时应用系统的构造也比拟灵敏。图3为开放式运动控制平台应用于伺服电机控制的构造图。它由三局部组成：采用PENTIUM200CPUIBMPC机；四轴开放式运动控制器；沟通伺服电机和驱动器采用松下MINAS-A系列100W伺服驱动器；位置伺服控制周期分别为250s和1ms。图4和图5分别是不同伺服控制周期时位置控制采用PID控制算法的正弦位置跟踪曲线，其中，r表示幅值为2500个脉冲、频率为4Hz的正弦给定信号，f表示实际位置反应，E表示位置跟踪误差。结果说明，系统可以方便地实现控制设置，具有较强的软件扩展才能。本文设计的开放式四轴运动控制平台，由于采用了高容量低本钱的CPLDEPF6016，将运动控制器所需的硬件资源进展了整合集成，进步了系统硬件的配置才能和可靠性，并且充分利用PC机软件资源方面的上风，采用C+语言“类的构造对运动控制算法进展封装，使系统软件也具有很好的开放性和集成性，可以方便地设计多种控制算法，实现“软运动控制功能。这种设计不仅降低了本钱，而且控制算法对使用者开放，便于根据实际对象采用不同的控制算法定制应用。0