专利名称：一种基于浮点dsp的伺服运动控制装置的制作方法
技术领域：
本发明涉及一种基于浮点DSP的伺服运动控制装置，主要用于惯性器件测试使用 的转台系统角运动控制领域，以实现角位置、角速率、角振动等各种运动形式的控制。
背景技术：
伺服电机的输入输出包括对电机的位置反馈信息的获取和控制量的输出。目前电 机的反馈类型主要集中为正交脉冲量反馈的编码器方式，而对电机的伺服控制中一般采用 针对电机控制专用的定点DSP芯片作为控制器的CPU，这类DSP的外设相当丰富，包括了数 字编码器的接口和PWM接口，也有一些A/D、D/A接口，对于一般的场合的电机控制应用较 为方便。但是对于高精度和要求进行负载运算的电机控制系统，若使用基于定点DSP作为 CPU单元，在进行浮点规律的运算时很不方便，且容易造成运算数据的定长截止，从而产生 误差。
发明内容
本发明的技术解决问题是克服现有技术的不足之处，提供一种基于浮点DSP的 伺服电机控制装置，用于实现对伺服电机或步进电机的高精度运动控制。本发明的技术解决方案是一种基于浮点DSP的伺服运动控制装置，包括DSP单元 电路、DSP电源电路、程序存储器电路、双口 RAM电路、PC104总线接口电路、板选控制电路、 正交计数器电路、I/O 口扩展电路、伺服接口电路和串口控制电路；DSP电源电路为DSP单元电路提供3. 3V和1. 8V两路电源，为PC104总线接口电路 提供5V电源；DSP单元电路，通过地址总线和数据总线与程序存储器电路、双口 RAM电路、正交 计数器电路、I/O 口扩展电路、串口控制电路相连接，DSP单元电路读取双口 RAM电路中的 运动控制指令，并根据运动控制指令将运动控制指令的执行结果通过PC104总线接口电路 或串口控制电路发送回上位机，DSP单元电路接收正交计数器电路生成的步进脉冲控制量， DSP单元电路根据步进脉冲控制量产生脉冲控制信号，脉冲控制信号由DSP单元电路的计 数器端口发送至伺服接口电路；程序存储器电路，用于存储DSP单元电路的控制程序，工作时DSP单元电路按照固 定的时序从程序存储器电路中读取控制程序指令并执行相应的操作；双口 RAM电路，与PC104总线相连用于接收上位机发出的运动控制指令，DSP单元 电路读取写入双口 RAM电路的运动控制指令，并根据运动控制指令执行相应的操作，DSP单 元电路将运动控制指令的执行结果写入双口 RAM电路，上位机通过PC104总线接口电路将 运动控制指令的执行结果进行读取，双口 RAM电路的读写使能由板选控制电路进行控制；PC104总线接口电路，分别与双口 RAM电路和上位机相连，用于将上位机发出的运 动控制指令写入双口 RAM电路，并由上位机通过PC104总线接口电路读取双口 RAM中存储 的运动控制指令执行结果；
板选控制电路，通过产生不同的地址编码控制双口 RAM电路的读写使能使；正交计数器电路，用于对编码器反馈的两路正交信号进行计数产生对伺服电机的 步进脉冲控制量，通过数据总线将步进脉冲控制量送至DSP单元电路；I/O 口扩展电路，与DSP单元电路相连用于扩展DSP单元电路的I/O接口；伺服接口电路，与DSP单元电路的计数器端相连用于将DSP单元电路产生的脉冲 控制信号传送至伺服电机驱动器，与I/O 口扩展电路相连用于扩展DSP单元电路的I/O接 口，与伺服电机驱动器相连用于对伺服电机进行控制，与编码器用于接收编码器产生的反 馈脉冲信号，与正交计数器电路相连用于正交计数器电路对编码器产生的反馈脉冲信号进 行计数；串口控制电路，用于将串口设置为RS-485或RS-422方式。所述DSP芯片采用TI公司TMS320VC33浮点数字信号处理器。所述程序存储器电路采用AM29F040芯片。所述正交计数器电路采用LS7266芯片。所述双口 RAM电路采用IDT7130芯片。所述板选控制电路由54LS688芯片和跳线器组成，将54LS688芯片的P组8位输 入口连接至PC104总线电路地址总线的A12 A19端，Q组8位输入口连接至8位跳线器， 将其输出信号P = Q连接至双口 RAM电路。本发明与现有技术相比的优点是采用本发明运动控制程序存储在程序存储器 中，上电后CPU按照固定的时序自动从程序存储器中调用程序并执行，并按程序对其它部 分电路进行操作，利用建立在浮点DSP上的软件可实现对光电编码器为反馈的交流伺服电 机的高精度运动控制，包括角位置、角速率以及角振动等运动方式。可作为PC104总线下的 扩展板使用，也可作为独立的运动控制器使用。通过将浮点DSP作为运动控制器的CPU单 元，可执行硬件浮点乘法和除法运算，运算速率比定点的DSP大为提高。该装置控制实时性 强，扩展灵活，控制系统的控制精度高，可应用于惯导测试设备领域的转台系统、伺服平台 以及机器人等要求精确角运动控制的领域。
图1是本发明的电路原理框图。图2是本发明的软件流程图。
具体实施例方式如图1所示，本发明由DSP单元电路、DSP电源电路、程序存储电路、双口 RAM电路、 PC104总线接口电路、板选控制电路、正交计数器电路、I/O 口扩展电路、伺服接口电路、串 口控制电路组成。DSP电源电路为DSP单元电路提供3. 3V和1. 8V两路电源，为PC104总线接口电路 提供5V电源；DSP单元电路，通过地址总线和数据总线与程序存储器电路、双口 RAM电路、正交 计数器电路、I/O 口扩展电路、串口控制电路相连接进行信息交换，DSP单元电路产生的脉 冲信号通过计数器端经伺服接口电路传送至伺服电机驱动器；DSP单元是整个装置的核心，所有对硬件的选通、读写、控制，都要通过DSP单元来实现。DSP单元电路对其它电路的 操作，都是通过地址总线、数据总线、和控制总线完成的。TCLK0即为DSP芯片中的“计数器 0”，用于产生伺服电机驱动器需要的脉冲信号，伺服接口电路作为DSP单元电路中TCLK0端 与伺服电机驱动器直接的接口。程序存储器电路，用于存储DSP单元电路的控制程序，本发明工作时DSP单元电路 按照固定的时序从程序存储器电路中读取控制程序指令并执行相应的操作；双口 RAM电路，与PC104总线相连用于接收上位机发出的运动控制指令并将其从 写入内存，DSP单元电路读取写入内存的运动控制指令，并根据运动控制指令执行相应的 操作，DSP单元电路将运动控制执行结果写入双口 RAM，上位机再通过PC104总线接口电路 将该信息进行读取，双口 RAM电路的读写使能由板选控制电路进行控制；DSP和上位机通过 双口 RAM交换的信息主要是两类一类是上位机将某个轴的指令信息(工作方式、位置、转 速等)写入双口 RAM，DSP单元电路再从双口 RAM中读取；第二类是DSP将本轴的实际信息 (实际位置、实际转速等)写入双口 RAM，上位机再从双口 RAM中读取，已知道该轴的实际信 息。由于上位机可能需要同时控制多个轴，而这些轴的控制器(即本装置)都是连接在一 个PC104总线上的，那么上位机怎么分别对某个轴操作呢？这就需要对每个双口 RAM事先 定义一个地址，上位机在发送指令的时候，都要先指明地址(即该指令是发给谁的)，当某 个双口 RAM发现指令的地址和自己一致时，就知道是给自己的，否则就不予理睬。上位机读 取轴状态也是同样的道理，根据地址，就知道它读的是哪个轴的状态。PC104总线接口电路，分别与双口 RAM电路和上位机相连，用于将上位机发出的 运动控制指令写入双口 RAM电路，并由上位机读取双口 RAM中存储的运动控制执行结果； PC104总线接口电路是本装置与上位机的接口，它的物理实质就是104根插针，这是一种国 际标准的PC104总线，把自己的电路板做成这样的形式，就可以和其它具有PC104总线接口 的设备互联进行数据传输。插针上的数据总线和地址总线与双口 RAM的输出端相连，电源 口和电源电路相连。板选控制电路，通过产生不同的地址编码控制双口 RAM电路的读写使能使；片选 电路由硬件组成，通过8位拨盘可确定本块板的地址，上位机的发送的地址与本板相同时， 板选电路输出一个低电平，选通双口 RAM的CEr信号，后面的数据就能进入本板的双口 RAM ； 当地址不一致时输出高电平，不选通双口 RAM，后面的数据就能不能进入本板的双口 RAM。正交计数器电路，用于对编码器反馈的两路正交信号进行计数，并通过数据总线 将计数结果送至DSP单元电路；I/O 口扩展电路，与DSP单元电路相连用于扩展DSP单元电路的I/O接口，运动控 制系统中，经常要用到许多的I/O 口，用于读入/输出一些开关量，如输出驱动器使能信号， 读入驱动器错误指示信号等。读入/输出这些信号都要通过DSP来执行，而DSP本身的1/ 0 口又十分有限，因此使用I/O 口扩展电路，可以增加I/O 口(通过8255可将8个为口扩展 为24个)。伺服接口电路，与DSP单元电路的计数器端相连用于将DSP单元电路产生的脉冲 信号传送至伺服电机驱动器，与I/O 口扩展电路相连用于将DSP单元电路产生的控制信号 输出至伺服电机驱动器，与伺服电机驱动器相连用于对伺服电机进行控制，与编码器用于 接收编码器产生的反馈脉冲信号，与正交计数器电路相连用于正交计数器电路对编码器产生的反馈脉冲信号进行计数；编码器产生的反馈信号为两路正交的脉冲信号，其频率值对 应于电机的实际转速值，该信号也通过伺服接口电路引入本装置，由正交计数电路对其计 数，便可知实际的转速值。伺服接口电路不直接连至电机，而是连至伺服电机驱动器，伺服 电机驱动器不仅是电机的功率输出器件，本身中也有一些电路。串口控制电路，用于将串口设置为RS-485或RS-422方式。串口的作用与双口 RAM 电路是一样的，只不过双口 RAM电路的数据交换速度要高的多。DSP单元电路按照程序不断执行上述伺服控制周期，可达0. 2ms的伺服更新周期， 从而实现了对电机轴的高精度伺服控制。此外，DSP单元还可根据上位机指令，通过扩展1/ 0 口写入或读取有关的开关量，如电机使能信号、轴角零位信号等。若作为PC104总线下的 扩展板使用，本装置可通过PC104总线多套并联，并根据板选控制电路将每块板设置为不 同的地址，可实现同时对最多256个电机的控制。若作为完整独立的运动控制器使用时，可 通过串口发送向本装置发送指令。DSP单元电路包括DSP芯片及晶振电路、复位电路、总线缓冲器等外围电路。DSP 芯片采用TI公司TMS320VC33浮点数字信号处理器，它通过24位的地址总线、32位的数据 总线和相应的控制总线控制装置的其它部分电路。DSP电源电路由DSP双电压源电路TPS76D318构成，能提供DSP单元工作所需的 3. 3V和1.8V两路电源。程序存储器电路由AM29F040芯片构成，它具有512K的8位Flash存储器，可将 DSP的控制程序下载到其中，并可反复多次擦写。将AM29F040芯片的19位地址总线接到 DSP单元地址总线的低19位，将其8位数据总线接到DSP单元数据总线的低8位。双口 RAM电路由IDT7130芯片构成，其L 口地址总线接DSP单元地址总线的低10 位，数据总线接DSP单元数据总线的低8位；R 口的地址总线接PC104总线的地址总线的低 10位，数据总线接DSP单元数据总线的低8位；双口 RAM电路从PC104总线接收上位机发 出的运动控制指令，并将其从R 口写入内存，DSP单元电路从L 口读取指令，并根据程序执 行相应的操作；同时，DSP将轴的状态信息通过L写入双口 RAM，上位机再将该信息从R 口读 取。PC104总线接口电路由标准0. 1英寸PC104总线插针构成，并将+5V电源引入DSP 电源电路的1IN、2IN输入端，作为DSP双电源的输入。板选控制电路由54LS688芯片和跳线器组成，将其P组8位输入口连接至PC104总 线地址总线的A12 A19端，Q组8位输入口连接至8位跳线器，将其输出信号P = Q连接 至双口 RAM电路4的CEr端。通过对跳线器的设置可设定本块板卡的地址编码，当在PC104 总线上有多块相同的运动控制板卡控制多个轴时，可将各板卡设置成不同的地址编码。当 PC104的上位机对某个轴发出控制指令前，必须先发出该轴对应板卡的地址编码信号，当该 地址编码与对应板卡的地址跳线器预设的地址相同时，通过该板的P = Q信号开通双口 RAM 电路的CEr端，对应轴的板卡才能收到相应的运动控制指令。正交计数器电路由LS7266芯片构成，其8位数据总线接到DSP单元数据总线的低 8位，2位地址总线接到DSP单元数据总线的低2位。XA、XB信号接伺服接口电路9的XA、 XB信号，可对编码器反馈的两路正交信号进行计数，并通过数据总线送DSP单元。I/O 口扩展电路由8255芯片构成，其8位数据总线接到DSP单元数据总线的低8位，2位地址总线接到DSP单元数据总线的低2位。8位PA 口、PB 口、PC 口分别接伺服接口 电路9的1/00 1/023端；通过对8255芯片写控制字的方式，将伺服接口电路9的24个 I/O端口任意设置为输出或输入方式，在默认情况下，本装置1/00 1/07为设置为输入方 式，1/08 1/023为输出方式。伺服接口电路由单排40脚标准插针构成，其一端接编码器反馈信号和用户I/O 口，另一端接正交计数器电路7和I/O 口扩展电路8，可将编码器反馈信号和用户I/O信号 引入系统；CT0端接DSP单元1的TCLK0端，作为伺服电机驱动器的脉冲控制信号输出端，使 用1/016 (由8255的PC0输出)作为伺服电机驱动器的方向控制信号，使用1/017 (由8255 的PC1输出)作为伺服电机驱动器的使能控制信号。串口控制电路由16C550芯片光耦6N137芯片和串口驱动芯片MAX485芯片构成。 16C550芯片的8位数据总线接到DSP单元数据总线的低8位，2位地址总线接到DSP单元 数据总线的低2位，并可通过对MAX485的输出进行跳线的方式将串口设置为RS-485或 RS-422 方式。如图2所示，上位机的运动控制指令通过PC104总线或串口发送给DSP单元电路， DSP单元电路根据运动控制指令的类型(角位置、角速率或角振动)执行相应的控制子程 序。在每种子程序中，CPU(DSP单元电路吗)以5kHz的速率通过正交计数器采集一次当前 轴角的位置信息(编码器反馈信号)，然后与指令值比较，根据控制算法计算出对伺服电机 的步进脉冲控制量，并将其转换为计数值，写入到正交计数器的TCLK0中。计数器TCLK0按 照计数值对晶振电路输出的基准脉冲信号进行计数，计算值满后改变输出电平，从而输出 所要求频率的方波信号。此方波信号通过伺服接口电路发送给伺服电机驱动器，驱动电机 按相应速率转动。同时，DSP单元还不断将当前的轴位置、速率等信息通过PC104总线或串 口发送回上位机。至此完成一个伺服控制周期。当作为PC104总线下的扩展板使用时，可通过PC104总线接口电路直接与上位机 PC104计算机相连，上位机通过PC104总线对本装置写入电机运动指令并读取电机状态参 数；当作为完整独立的运动控制器使用时，可通过串口控制电路直接与上位机PC104计算 机相连，上位机通过RS-485或RS-422串口对本装置写入电机运动指令并读取电机状态参数。本发明未详细描述内容为本领域技术人员公知技术。
权利要求
一种基于浮点DSP的伺服运动控制装置，其特征在于包括DSP单元电路、DSP电源电路、程序存储器电路、双口RAM电路、PC104总线接口电路、板选控制电路、正交计数器电路、I/O口扩展电路、伺服接口电路和串口控制电路；DSP电源电路为DSP单元电路提供3.3V和1.8V两路电源，为PC104总线接口电路提供5V电源；DSP单元电路，通过地址总线和数据总线与程序存储器电路、双口RAM电路、正交计数器电路、I/O口扩展电路、串口控制电路相连接，DSP单元电路读取双口RAM电路中的运动控制指令，并根据运动控制指令将运动控制指令的执行结果通过PC104总线接口电路或串口控制电路发送回上位机，DSP单元电路接收正交计数器电路生成的步进脉冲控制量，DSP单元电路根据步进脉冲控制量产生脉冲控制信号，脉冲控制信号由DSP单元电路的计数器端口发送至伺服接口电路；程序存储器电路，用于存储DSP单元电路的控制程序，工作时DSP单元电路按照固定的时序从程序存储器电路中读取控制程序指令并执行相应的操作；双口RAM电路，与PC104总线相连用于接收上位机发出的运动控制指令，DSP单元电路读取写入双口RAM电路的运动控制指令，并根据运动控制指令执行相应的操作，DSP单元电路将运动控制指令的执行结果写入双口RAM电路，上位机通过PC104总线接口电路将运动控制指令的执行结果进行读取，双口RAM电路的读写使能由板选控制电路进行控制；PC104总线接口电路，分别与双口RAM电路和上位机相连，用于将上位机发出的运动控制指令写入双口RAM电路，并由上位机通过PC104总线接口电路读取双口RAM中存储的运动控制指令执行结果；板选控制电路，通过产生不同的地址编码控制双口RAM电路的读写使能使；正交计数器电路，用于对编码器反馈的两路正交信号进行计数产生对伺服电机的步进脉冲控制量，通过数据总线将步进脉冲控制量送至DSP单元电路；I/O口扩展电路，与DSP单元电路相连用于扩展DSP单元电路的I/O接口；伺服接口电路，与DSP单元电路的计数器端相连用于将DSP单元电路产生的脉冲控制信号传送至伺服电机驱动器，与I/O口扩展电路相连用于扩展DSP单元电路的I/O接口，与伺服电机驱动器相连用于对伺服电机进行控制，与编码器用于接收编码器产生的反馈脉冲信号，与正交计数器电路相连用于正交计数器电路对编码器产生的反馈脉冲信号进行计数；串口控制电路，用于将串口设置为RS-485或RS-422方式。
2.根据权利要求1所述的一种基于浮点DSP的伺服运动控制装置，其特征在于所述 DSP芯片采用TI公司TMS320VC33浮点数字信号处理器。
3.根据权利要求1所述的一种基于浮点DSP的伺服运动控制装置，其特征在于所述 程序存储器电路采用AM29F040芯片。
4.根据权利要求1所述的一种基于浮点DSP的伺服运动控制装置，其特征在于所述 正交计数器电路采用LS7266芯片。
5.根据权利要求1所述的一种基于浮点DSP的伺服运动控制装置，其特征在于所述 双口 RAM电路采用IDT7130芯片。
6.根据权利要求1所述的一种基于浮点DSP的伺服运动控制装置，其特征在于所述板选控制电路由54LS688芯片和跳线器组成，将54LS688芯片的P组8位输入口连接至 PC104总线电路地址总线的A12 A19端，Q组8位输入口连接至8位跳线器，将其输出信 号P = Q连接至双口 RAM电路。
全文摘要
一种基于浮点DSP的伺服运动控制装置，由DSP单元电路、电源电路、程序存储电路、双口RAM电路、PC104总线接口电路、板选控制电路、正交计数器电路、I/O口扩展电路、伺服接口电路、串口控制电路组成。本发明利用建立在浮点DSP上的软件可实现对光电编码器为反馈的交流伺服电机的高精度运动控制，包括角位置、角速率以及角振动等运动方式，可作为PC104总线下的扩展板使用，也可作为独立的运动控制器使用。该装置控制实时性强，扩展灵活，控制系统的控制精度高，可应用于惯导测试设备领域的转台系统、伺服平台以及机器人等要求精确角运动控制的领域。
文档编号H02P6/08GK101860296SQ20101016373
公开日2010年10月13日 申请日期2010年4月29日 优先权日2010年4月29日
发明者周宏新, 杨明, 王胜利, 胡吉昌, 赵郭有为 申请人:北京航天控制仪器研究所