非接触式机器人测控系统的开发.docx

《非接触式机器人测控系统的开发.docx》由会员分享，可在线阅读，更多相关《非接触式机器人测控系统的开发.docx（9页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、非接触式机器人测控系统的开发dujing导语：介绍了一种新型的非接触式机器人测控系统，阐述了系统设计思想及其组成和工作原理。DevelOpmentOfNoncontactRoboticMeasuringandControlSystem摘要：介绍了一种新型的非接触式机器人测控系统，阐述了系统设计思想及其组成和工作原理。该系统由非正交系的坐标执行机构、激光位移传感器和CCD摄像头等测量系统以及主从式的控制系统组成，能在有限的测量空间内，实现球壳类、向转类工件的几何尺寸、外表缺陷的高精度测量。测试说明，该测控系统具有可靠的稳定性和较高的测量精度。随着科学技术和当代制造业的开展，工件的制造精度越来越高

2、，因此对测量设备的精度和功能的要求也越来越高，而且新型专用的测量设备的需求也日益增多。传统的测量机，大都基于一种几何坐标系，如笛卡儿坐标系、柱坐标系等。这些测量机，机械构造比拟直观，控制算法简单，测量精度高，系统的误差模型经多年的研究已完善。但在有些特殊场合，这些测量机不能适应。而非正交坐标测量系统由于其所具有高的灵敏性已经成为坐标测量机的开展趋势。笔者经大量的调查研究，方案比拟，参数的计算与优化，计算机仿真；并充分考虑精度、效率、可靠性、操纵性、空间的兼容性等，在基于直角坐标系与原柱坐标系的固定桥式、关节机器人测量机等多种方案的根底上，为在有限的空间实现半球自动非接触测量，将机器人机构与激光

3、非接触测量传感器技术相结合，研制了一种新型的机器人测控系统。该系统在球壳类工件的几何尺寸和外表缺陷的测量中具有高速、高精度的特点。2系统的工作原理本系统由机械执行机构、CCD摄像头和激光位移传感器及光珊等测量系统、控制系统3局部组成。机械执行机构是非接触测量系统的主体局部。由图1可见，机械构造主要由基座、机械手、高精度回转台、两维调平工作台等局部组成。激光位移传感器安装在机械手的末端，CCD摄像头安装在激光位移传感器的下方。在测量中具有3个自由度的机械手作为测量主体。基座的中央安装了一个高精度的回转主轴，在回转主轴的上端，安装一个两维调平工作台，使被测件的回转轴与回转台的回转轴重合。测量时，将

4、工件放在测量平台上，回转台转动1周，测量系统测量出半球中心的位置，位置误差被显示在面板上。在计算机提示操纵下，将半球与回转轴调同心。然后，机器手挪动到第一个测量位置，工作台旋转，激光传感器进展测量。随后机器手挪动到下一个测量位置，重复上述经过。当整个球面扫描完成后，就可以获得球体的外表特征。该测量系统不仅可以测量半球壳，还可以测量它们的各种组合型体，以及其它回转类工件。align=center1-激光传感器和CCD摄像头2-机械手3-扇形轮4-被测件5-回转台和调平工作台图1测量机器人机械构造/align3控制系统设计本系统运动控制复杂，信号量大，而且对系统的稳定性和精度要求高，所以控制系统采

5、用了多CPU构造、分布式控制方式，这种控制系统采用集中治理分散控制的方法，具有高的稳定性、工作速度和控制性能。为了进一步进步系统的实时性、稳定性，控制系统中采用DSP多轴运动控制器。主计算机采用PC主机，控制计算机采用工业控制计算机，整个软件系统架构在WindowsNT和Windows2000上。为了进步系统整体的测量精度，在详细程序中使用了误差补偿技术。用长光栅测弧长来实现角度测量的高分辨率要求，实现空间上的高精度定位。程序开发语言使用C+。选用它的原因是C+语言的高效性，更重要的是和其它程序有很好的兼容性和移植性。3.1控制系统构造本测量机的控制系统如图2所示，主要由主计算机、控制计算机、

6、DSP运动控制器、伺服系统、操纵盒等组成。这样的控制方式，增强了运动控制的可靠性和实时性。align=center图2控制系统原理图/align1主计算机采用PC主机，它施行对控制计算机的控制、人机接口、数据通讯、数据处理、测量要素评价、数据库治理、图像收集和处理等工作。控制计算机采用工业控制计算机，控制机构的空间姿态，实时监测机构的运行状态，读取空间坐标值和测量数据。2控制计算机通过标准的通讯端口RS232与主计算机通讯，接收主计算机发出的控制指令，完成各种运动指令与运动控制，同时将收集的数据与运行状态返回给主计算机。3运动控制器选用了美国MEI公司MotionEngineering，Inc

7、.的4轴DSP运动控制器。DSP通过它自己的地址与数据总线与数据存储区、I/O端口及其它外设，如模拟输入与输出、定时器、位置缓冲区等进展双向数据通讯。作为PC的智能运动控制器，主CPU通过3字节的自己的I/O地址，直接访问这些地址与数据总线，与DSP通过外部数据存储区实现数据交换。这样，主CPU不必每次通过DSP存放器按ASCII字符逐个字符传送，也防止了从ASCII到二进制的转换。它直接进展二进制数的传输，因此大大进步了CPU与DSP的通讯速率。一般情况下，主CPU只在每个控制周期一帧一帧地将一个数据构造传给DSP。运动控制经过中，基于DSP运动控制器的运动控制的主要任务是：伺服控制功能：运

8、动控制器提供了PID和位置伺服环滤波器，为了减少伺服系统的轨迹误差，还提供了速度和加速度前馈控制；运动控制功能：可以进展直线和圆弧插补，自动完成梯形或者s曲线加减速控制；零位、限位检测；实时运动状态监控。4伺服系统用以实现系统的位置伺服控制和主轴转速伺服控制。本系统采用速度内环和位置外环的双环控制形式全闭环。单轴伺服控制系统构造如图3所示，其工作原理：位置信号编码器信号经过细分、整形后送人计数器，进而获得实际的空间坐标值。DSP将实际坐标值和命令坐标值进展比拟设定的坐标值由插补计算得出，得到位置误差，DSP运动控制器将位置误差代人PID调节器，得到控制电压，并通过模拟通道将控制电压送到伺服驱动

9、器，由伺服驱动器控制电机运转，进而形成外部位置环。速度调节环由伺服驱动器内部接收电机编码器信号进展速度控制。这样就形成了本系统的双环控制形式。align=center图3单轴伺服系统/align5操纵盒为操纵人员提供了一个便利的现场操纵前台，使用户可以近间隔操纵测量机，实现某些特定的功能。操纵盒采用以单片机为核心的智能前端，通过标准接口与控制计算机进展通讯，实现测量机主体的现场控制，实时显示控制计算机发送的信息。6测量系统X、Y、Z和W四个轴的读数，都是由控制计算机读取，并传给主计算机。摄像测头具有相对的独立性，为便于其开发以及与整个测量系统软件的连接，将运动控制与图像收集分开：运动控制通过控

10、制计算机实现，图像收集那么直接由主计算机实现。激光测头的运动控制和数据收集均由控制计算机完成。3.2控制系统软件3.2.1轨迹规划和测量控制软件体系align=center图4运动控制软件流程/align轨迹规划和测量控制软件是系统的核心，它要完成人机交互，控制测量机按照测量途径进展测量，平安控制，数据的收集与治理。轨迹规划和测量控制软件的流程如图4所示，主要包括以下功能模块：1通讯模块。负责治理控制计算机与主计算机、控制盒的通讯。其中，主计算机使用串口1，控制盒使用串口2。当接收到指令时，产生中断，置指令标志。主程序通过检测该标志，判定是否有指令。2主测量模块。主要完成测量途径规划及实现专用

11、测量功能，包括内球面的测量控制、外球面的测量控制、圆柱的测量控制、平面的测量控制、外表缺陷等的测量控制，系统参数的标定测量控制，同时还负责控制机构点对点的运动等功能。3初始化模块。主要对系统参数、标志位、通讯端口和测量系统等进展初始化。4辅助功能模块。测量机回零、复位、工件调偏、单轴运动、三轴联动和随动等。5运动状态监控模块。主要是测量机软硬件限位、DSP运动控制器初始化、系统参数和电机运行状态等的监控。一旦检测到错误，那么停顿当前测量，向主计算机发送报警信息和出错原因，便于用户调整，保证了测量机运行的平安性。6数据收集模块。主要负责对数据收集卡的初始化和测头、关节编码器数据的实时收集与处理。

12、3.2.2系统监测软件为了保障测量系统的平安性和可靠性，必须对运动进展监控。运动监控的流程如图5所示，主要包括主计算机、操纵盒停顿指令监控、测量机运动状态监控。测量机运动状态的监控的功能主要是测量机软硬件限位、DSP运动控制器初始化、系统参数和电机运行状态等的监控。一旦检测到错误，那么停顿当前测量，向主计算机发送报警信息和出错原因，便于用户调整。运动监控保证了测量机运行的平安性，是运动控制中非常重要的模块。4系统标定4.1系统标定align=center图5运动监控流程/align为了实现控制轨迹要求的末端执行器位姿的坐标，本测量系统使用专用的实物基准作为标准件，采用相对基准自标定的方法，对该测量系统进展了系统参数的标定。4.2系统测试该机器人测控系统成功地应用在球壳体工件几何尺寸及其外表形貌的无损测量中，表1是对某半球的测量结果。表中的数据说明该测控系统的具有较高的测量精度和可靠的稳定性。align=center表1/align本文介绍了一种新型的测控系统，该测控系统将机器人技术、非接触测量技术和主从控制相结合，实现了几何量测量和缺陷识别。系统本身具有一定的先进性和广泛的应用前景。经测试该测控系统的具有较高的测量精度和可靠的稳定性。为了进一步进步系统的稳定性和测量精度，更深化的研究和实验正在进展中。0