摘要：介紹了一種新型的非接觸式機器人測控系統(tǒng)，論述了系統(tǒng)設(shè)計思想及其組成和工作原理。該系統(tǒng)由非正交系的坐標執(zhí)行機構(gòu)、
激光位移傳感器和CCD攝像頭等測量系統(tǒng)以及主從式的控制系統(tǒng)組成，能在有限的測量空間內(nèi)，實現(xiàn)球殼類、向轉(zhuǎn)類工件的幾何尺寸、表面缺陷的高精度測量。測試表明，該測控系統(tǒng)具有可靠的穩(wěn)定性和較高的測量精度。
1 引言
隨著科學技術(shù)和現(xiàn)代制造業(yè)的發(fā)展，工件的制造精度越來越高，因此對測量設(shè)備的精度和功能的要求也越來越高，而且新型專用的測量設(shè)備的需求也日益增多。傳統(tǒng)的測量機，大都基于一種幾何坐標系，如笛卡兒坐標系、柱坐標系等。這些測量機，機械結(jié)構(gòu)比較直觀，控制算法簡單，測量精度高，系統(tǒng)的誤差模型經(jīng)多年的研究已完善。但在有些特殊場合，這些測量機不能適應(yīng)。而非正交坐標測量系統(tǒng)由于其所具有高的靈活性已經(jīng)成為坐標測量機的發(fā)展趨勢。筆者經(jīng)大量的調(diào)查研究，方案比較，參數(shù)的計算與優(yōu)化，計算機仿真；并充分考慮精度、效率、可靠性、操作性、空間的兼容性等，在基于直角坐標系與原柱坐標系的固定橋式、關(guān)節(jié)機器人測量機等多種方案的基礎(chǔ)上，為在有限的空間實現(xiàn)半球自動非接觸測量，將機器人機構(gòu)與激光非接觸測量傳感器技術(shù)相結(jié)合，研制了一種新型的機器人測控系統(tǒng)。該系統(tǒng)在球殼類工件的幾何尺寸和表面缺陷的測量中具有高速、高精度的特點。
2 系統(tǒng)的工作原理
本系統(tǒng)由機械執(zhí)行機構(gòu)、CCD攝像頭和
激光位移傳感器及光珊等測量系統(tǒng)、控制系統(tǒng)3部分組成。機械執(zhí)行機構(gòu)是非接觸測量系統(tǒng)的主體部分。由圖1可見，機械結(jié)構(gòu)主要由基座、機械手、高精度回轉(zhuǎn)臺、兩維調(diào)平工作臺等部分組成。激光位移傳感器安裝在機械手的末端，CCD攝像頭安裝在激光位移傳感器的下方。在測量中具有3個自由度的機械手作為測量主體。
基座的中央安裝了一個高精度的回轉(zhuǎn)主軸，在回轉(zhuǎn)主軸的上端，安裝一個兩維調(diào)平工作臺，使被測件的回轉(zhuǎn)軸與回轉(zhuǎn)臺的回轉(zhuǎn)軸重合。測量時，將工件放在測量平臺上，回轉(zhuǎn)臺轉(zhuǎn)動1周，測量系統(tǒng)測量出半球中心的位置，位置誤差被顯示在面板上。在計算機提示操作下，將半球與回轉(zhuǎn)軸調(diào)同心。然后，機器手移動到第一個測量位置，工作臺旋轉(zhuǎn)，激光傳感器進行測量。隨后機器手移動到下一個測量位置，重復(fù)上述過程。當整個球面掃描完成后，就可以獲得球體的表面特征。該測量系統(tǒng)不僅可以測量半球殼，還可以測量它們的各種組合型體，以及其它回轉(zhuǎn)類工件。
1-激光傳感器和CCD攝像頭 2-機械手 3-扇形輪 4-被測件 5-回轉(zhuǎn)臺和調(diào)平工作臺
圖1 測量機器人機械結(jié)構(gòu)
3 控制系統(tǒng)設(shè)計
本系統(tǒng)運動控制復(fù)雜，信號量大，而且對系統(tǒng)的穩(wěn)定性和精度要求高，所以控制系統(tǒng)采用了多CPU結(jié)構(gòu)、分布式控制方式，這種控制系統(tǒng)采用集中管理分散控制的方法，具有高的穩(wěn)定性、工作速度和控制性能。為了進一步提高系統(tǒng)的實時性、穩(wěn)定性，控制系統(tǒng)中采用DSP多軸運動控制器。主計算機采用PC主機，控制計算機采用工業(yè)控制計算機，整個軟件系統(tǒng)架構(gòu)在WindowsNT和Windows 2000上。為了提高系統(tǒng)整體的測量精度，在具體程序中使用了誤差補償技術(shù)。用長光柵測弧長來實現(xiàn)角度測量的高分辨率要求，實現(xiàn)空間上的高精度定位。程序開發(fā)語言使用C++。選用它的原因是C++語言的高效性，更重要的是和其它程序有很好的兼容性和移植性。
3.1 控制系統(tǒng)結(jié)構(gòu)
本測量機的控制系統(tǒng)如圖2所示，主要由主計算機、控制計算機、DSP運動控制器、伺服系統(tǒng)、操縱盒等組成。這樣的控制方式，增強了運動控制的可靠性和實時性。
圖2 控制系統(tǒng)原理圖
（1）主計算機采用PC主機，它實施對控制計算機的控制、人機接口、數(shù)據(jù)通訊、數(shù)據(jù)處理、測量要素評價、數(shù)據(jù)庫管理、圖像采集和處理等工作。控制計算機采用工業(yè)控制計算機，控制機構(gòu)的空間姿態(tài)，實時監(jiān)測機構(gòu)的運行狀態(tài)，讀取空間坐標值和測量數(shù)據(jù)。
（2）控制計算機通過標準的通訊端口RS232與主計算機通訊，接收主計算機發(fā)出的控制指令，完成各種運動指令與運動控制，同時將采集的數(shù)據(jù)與運行狀態(tài)返回給主計算機。
（3）運動控制器選用了美國MEI公司（Motion Engineering，Inc.）的4軸DSP運動控制器。DSP通過它自己的地址與數(shù)據(jù)總線與數(shù)據(jù)存儲區(qū)、I/O端口及其它外設(shè)，如模擬輸入與輸出、定時器、位置緩沖區(qū)等進行雙向數(shù)據(jù)通信。作為PC的智能運動控制器，主CPU通過3字節(jié)的自己的I/O地址，直接訪問這些地址與數(shù)據(jù)總線，與DSP通過外部數(shù)據(jù)存儲區(qū)實現(xiàn)數(shù)據(jù)交換。這樣，主CPU不必每次通過DSP寄存器按ASCII字符逐個字符傳送，也避免了從ASCII到二進制的轉(zhuǎn)換。它直接進行二進制數(shù)的傳輸，因此大大提高了CPU與DSP的通信速率。一般情況下，主CPU只在每個控制周期一幀一幀地將一個數(shù)據(jù)結(jié)構(gòu)傳給DSP。運動控制過程中，基于DSP運動控制器的運動控制的主要任務(wù)是：①伺服控制功能：運動控制器提供了PID和位置伺服環(huán)
濾波器，為了減少伺服系統(tǒng)的軌跡誤差，還提供了速度和加速度前饋控制；②運動控制功能：可以進行直線和圓弧插補，自動完成梯形或s曲線加減速控制；③零位、限位檢測；④實時運動狀態(tài)監(jiān)控。
（4）伺服系統(tǒng)用以實現(xiàn)系統(tǒng)的位置伺服控制和主軸轉(zhuǎn)速伺服控制。本系統(tǒng)采用速度內(nèi)環(huán)和位置外環(huán)的雙環(huán)控制模式（全閉環(huán)）。單軸伺服控制系統(tǒng)結(jié)構(gòu)如圖3所示，其工作原理：位置信號（編碼器信號）經(jīng)過細分、整形后送人計數(shù)器，從而獲得實際的空間坐標值。DSP將實際坐標值和命令坐標值進行比較（設(shè)定的坐標值由插補計算得出），得到位置誤差，DSP運動控制器將位置誤差代人PID調(diào)節(jié)器，得到控制電壓，并通過模擬通道將控制電壓送到
伺服驅(qū)動器，由伺服驅(qū)動器控制電機運轉(zhuǎn)，從而形成外部位置環(huán)。速度調(diào)節(jié)環(huán)由伺服驅(qū)動器內(nèi)部接收電機編碼器信號進行速度控制。這樣就形成了本系統(tǒng)的雙環(huán)控制模式。
圖3 單軸伺服系統(tǒng)
（5）操縱盒為操作人員提供了一個便利的現(xiàn)場操作前臺，使用戶可以近距離操作測量機，實現(xiàn)某些特定的功能。操縱盒采用以單片機為核心的智能前端，通過標準接口與控制計算機進行通訊，實現(xiàn)測量機主體的現(xiàn)場控制，實時顯示控制計算機發(fā)送的信息。
（6）測量系統(tǒng)X、Y、Z和W四個軸的讀數(shù)，都是由控制計算機讀取，并傳給主計算機。攝像測頭具有相對的獨立性，為便于其開發(fā)以及與整個測量系統(tǒng)軟件的連接，將運動控制與圖像采集分開：運動控制通過控制計算機實現(xiàn)，圖像采集則直接由主計算機實現(xiàn)。激光測頭的運動控制和數(shù)據(jù)采集均由控制計算機完成。
3.2 控制系統(tǒng)軟件
3.2.1 軌跡規(guī)劃和測量控制軟件體系
圖4 運動控制軟件流程
軌跡規(guī)劃和測量控制軟件是系統(tǒng)的核心，它要完成人機交互，控制測量機按照測量路徑進行測量，安全控制，數(shù)據(jù)的采集與管理。軌跡規(guī)劃和測量控制軟件的流程如圖4所示，主要包括以下功能模塊：
（1）通訊模塊。負責管理控制計算機與主計算機、控制盒的通信。其中，主計算機使用串口1，控制盒使用串口2。當接收到指令時，產(chǎn)生中斷，置指令標志。主程序通過檢測該標志，判斷是否有指令。
（2）主測量模塊。主要完成測量路徑規(guī)劃及實現(xiàn)專用測量功能，包括內(nèi)球面的測量控制、外球面的測量控制、圓柱的測量控制、平面的測量控制、表面缺陷等的測量控制，系統(tǒng)參數(shù)的標定測量控制，同時還負責控制機構(gòu)點對點的運動等功能。
（3）初始化模塊。主要對系統(tǒng)參數(shù)、標志位、通信端口和測量系統(tǒng)等進行初始化。
（4）輔助功能模塊。測量機回零、復(fù)位、工件調(diào)偏、單軸運動、三軸聯(lián)動和隨動等。
（5）運動狀態(tài)監(jiān)控模塊。主要是測量機軟硬件限位、DSP運動控制器初始化、系統(tǒng)參數(shù)和電機運行狀態(tài)等的監(jiān)控。一旦檢測到錯誤，則停止當前測量，向主計算機發(fā)送報警信息和出錯原因，便于用戶調(diào)整，保證了測量機運行的安全性。
（6）數(shù)據(jù)采集模塊。主要負責對數(shù)據(jù)采集卡的初始化和測頭、關(guān)節(jié)編碼器數(shù)據(jù)的實時采集與處理。
3.2.2 系統(tǒng)監(jiān)測軟件
為了保障測量系統(tǒng)的安全性和可靠性，必須對運動進行監(jiān)控。運動監(jiān)控的流程如圖5所示，主要包括主計算機、操縱盒停止指令監(jiān)控、測量機運動狀態(tài)監(jiān)控。
測量機運動狀態(tài)的監(jiān)控的功能主要是測量機軟硬件限位、DSP運動控制器初始化、系統(tǒng)參數(shù)和電機運行狀態(tài)等的監(jiān)控。一旦檢測到錯誤，則停止當前測量，向主計算機發(fā)送報警信息和出錯原因，便于用戶調(diào)整。運動監(jiān)控保證了測量機運行的安全性，是運動控制中非常重要的模塊。
4 系統(tǒng)標定
4.1 系統(tǒng)標定
圖5 運動監(jiān)控流程
為了實現(xiàn)控制軌跡要求的末端執(zhí)行器位姿的坐標，本測量系統(tǒng)使用專用的實物基準作為標準件，采用相對基準自標定的方法，對該測量系統(tǒng)進行了系統(tǒng)參數(shù)的標定。
4.2 系統(tǒng)測試
該機器人測控系統(tǒng)成功地應(yīng)用在球殼體工件幾何尺寸及其表面形貌的無損測量中，表1是對某半球的測量結(jié)果。表中的數(shù)據(jù)表明該測控系統(tǒng)的具有較高的測量精度和可靠的穩(wěn)定性。
表1
5 結(jié)論
本文介紹了一種新型的測控系統(tǒng)，該測控系統(tǒng)將機器人技術(shù)、非接觸測量技術(shù)和主從控制相結(jié)合，實現(xiàn)了幾何量測量和缺陷識別。系統(tǒng)本身具有一定的先進性和廣泛的應(yīng)用前景。經(jīng)測試該測控系統(tǒng)的具有較高的測量精度和可靠的穩(wěn)定性。為了進一步提高系統(tǒng)的穩(wěn)定性和測量精度，更深入的研究和實驗正在進行中。
