C154四軸運(yùn)動控制卡

1、碩士學(xué)位論文工業(yè)機(jī)器人運(yùn)動控制與測試平臺開發(fā)專業(yè)名稱：控制理論與控制工程研究生姓名：馬妍妍導(dǎo)師姓名： 馬旭東教扌IllY2706258.Development of Motion Control andTest Platform for Industrial RobotA Dissertation Submitted toSoutheast UniversityFor the Academic Degree of Master of EngineeringBYMA YanyanSupervised byProf. MA XudongSchool of AutomationSoutheast U

2、niversityMarch 2014東南大學(xué)學(xué)位論文獨(dú)創(chuàng)性聲明本人聲明所呈交的學(xué)位論文是我個人在導(dǎo)師指導(dǎo)下進(jìn)行的研究工作及取得 的研究成果。盡我所知，除了文中特別加以標(biāo)注和致謝的地方外，論文中不包含 其他人已經(jīng)發(fā)表或撰寫過的研究成果，也不包含為獲得東南大學(xué)或其它教育機(jī)構(gòu) 的學(xué)位或證書而使用過的材料。與我一同工作的同志對本研究所做的任何貢獻(xiàn)均 已在論文中作了明確的說明并表示了謝意。研究生簽名:東南大學(xué)學(xué)位論文使用授權(quán)聲明東南大學(xué)、中國科學(xué)技術(shù)信息研究所、國家圖書館有權(quán)保留本人所送交學(xué)位 論文的復(fù)印件和電子文檔，可以采用影印.縮印或其他復(fù)制手段保存論文。本人 電子文檔的內(nèi)容和紙質(zhì)論文的內(nèi)容相一致

3、。除在保密期內(nèi)的保密論文和在技術(shù)保 護(hù)期限內(nèi)的論文外，允許論文被查閱和借閱，可以公布（包括以電子信息形式刊 登）論文的全部內(nèi)容或中.英文摘要等部分內(nèi)容。論文的公布（包括以電子信息 形式刊登）授權(quán)東南大學(xué)研究生院辦理。研究生簽名：召価妍 導(dǎo)師簽名:日 期也上土y摘要工業(yè)機(jī)器人運(yùn)動控制與測試平臺開發(fā)碩士研究生：馬妍妍導(dǎo) 師：馬旭東教授學(xué)校名稱：東南大學(xué)摘要隨著工業(yè)生產(chǎn)規(guī)模的擴(kuò)大及勞動力成本的提高，機(jī)器人作為提高工業(yè)生產(chǎn)自 動化程度的重要設(shè)備，在諸多領(lǐng)域得以推廣和應(yīng)用，但工業(yè)機(jī)器人核心控制技術(shù) 一直為國外廠商所壟斷，進(jìn)行國產(chǎn)化開放式機(jī)器人運(yùn)動控制系統(tǒng)研究開發(fā)意義重 大。本文針對國產(chǎn)化機(jī)器人運(yùn)動控制器

4、和測試平臺開發(fā)需要，系統(tǒng)研究了基于高 速實(shí)時以太網(wǎng)和基于PCI總線運(yùn)動控制卡兩種架構(gòu)方式的開放式運(yùn)動控制器，并 結(jié)合模塊化關(guān)節(jié)、高頻采樣和三維仿真等技術(shù)研究了性能測試平臺的設(shè)計和實(shí)現(xiàn)。論文首先從KeMotion系統(tǒng)功能分析與開放式控制系統(tǒng)特點(diǎn)出發(fā)，闡述了面 向運(yùn)動控制和測試評估研究的系統(tǒng)總體方案。分析研究模塊化關(guān)節(jié)在本系統(tǒng)應(yīng)用 的合理性，通過合理選擇伺服驅(qū)動.伺服電機(jī)、檢測編碼器及傳動機(jī)構(gòu)等模塊， 給出了集運(yùn)動控制與性能測試功能于一體的系統(tǒng)驗(yàn)證平臺設(shè)計。模塊化關(guān)節(jié)的使 用，大大拓展了系統(tǒng)的應(yīng)用范圍。機(jī)械系統(tǒng)精度測試結(jié)果表明滿足系統(tǒng)需求。在上述平臺的基礎(chǔ)上，針對基于髙速以太網(wǎng)通信的控制系統(tǒng)研究，

5、給出了有 PC和CIFX50網(wǎng)絡(luò)控制器構(gòu)建的SERCOS III通信主站控制Rextoth伺服的實(shí)現(xiàn) 方法，并給出了測試方案。針對基本機(jī)器人應(yīng)用，利用運(yùn)動控制卡開發(fā)了 SCARA 機(jī)器人開放式控制系統(tǒng)，并詳細(xì)介紹了機(jī)器人運(yùn)動學(xué).雅克比矩陣的計算及參數(shù) 設(shè)置、示教再現(xiàn)、監(jiān)控.運(yùn)動規(guī)劃等模塊的功能實(shí)現(xiàn)，軟件開發(fā)中的多線程及面 相對象等技術(shù)的應(yīng)用保證了系統(tǒng)良好的可移植性和擴(kuò)展性。接著進(jìn)行了采樣及性 能測試系統(tǒng)的開發(fā)，介紹了高精度采樣及0penGL三維建模仿真的實(shí)現(xiàn)方法，給 出了在該平臺上實(shí)現(xiàn)機(jī)器人速度插補(bǔ).直線插補(bǔ).圓弧插補(bǔ)等運(yùn)動規(guī)劃的仿真研 究方法。最后通過系統(tǒng)集成，進(jìn)行了 SCARA機(jī)器人開放式

6、控制系統(tǒng)性能測試。 結(jié)果表明軟件系統(tǒng)運(yùn)行良好，達(dá)到測控系統(tǒng)的設(shè)計功能要求。關(guān)鍵字：工業(yè)機(jī)器人，控制器，測試平臺，軌跡規(guī)劃，SERCOS III, OpenGLDevelopment of Motion Control and Test Platform forIndustrial RobotMaster Candidate: MA YanyanSupervised by: Prof. MA XudongSchool of Automation, Southeast University, 2014ABSTRACTAlong with the enhancement of the industr

7、ial production scale and labor costs» robots have been widely used in many fields, as powerful means for high level automation of the industry-process. However, robot controllers are still monopolized by several foreign companies, which are core of the robot systems Therefore> it's signi

8、ficant for the development research of the open robot controller with open structure and its testing platform Through implementation of modular joint models, high-frequency sampling and 3D simulation technology, the research on the development of industrial robot controller and testing platform is p

9、resented in this dissertation, which supporting high speed Ethernet servo bus and PCI bus based motion control and testing systems.Firstly, the overall design of motion control and test system is proposed after analyzing functions of KeMotion controller and features of open robot controller. Based o

10、n rationality of using modular joint in this system, the hardware composed of servo drive servo motor, encoder and gear drive is designed. The tested accuracy of the mechanical system meets the system requirements. Additionally, the use of modular joint greatly extends the application rangeFor resea

11、rch of robot control system with high-speed Ethernet communication, the controller based on PC and CIFX50 is designed with SERCOS III protocol and corresponding test program is proposed based on platform above Aim at basic robotic applications > a SCARA control system is developed by use of motio

12、n control card and the kinematic equations, Jacobian matrix calculation, parameter settings, teaching and playback, monitoring, motion planning and other functions are discribled in detail. Adoption of technologies such as multi-threading and object oriented programming makes the system with good po

13、rtability and scalability. Followed by the acquisition and test system, a 3D simulation model is developed Experiments and tests validate the SCARA control system，s performance.The results prove that software system runs well and achieve the requirements of the measurement and control system.Keyword

14、s: Industrial Robot > Controller > Test Platform, Trajectory Planning, SERCOS III, OpenGL目錄摘要IABSTRACTII目錄III第一章緒論11-1引言11.2機(jī)器人控制系統(tǒng)112.1機(jī)器人與多軸運(yùn)動控制1122國外機(jī)器人運(yùn)動控制系統(tǒng)研究與技術(shù)現(xiàn)狀212.3國內(nèi)機(jī)器人運(yùn)動控制系統(tǒng)研究與技術(shù)現(xiàn)狀41.3機(jī)器人運(yùn)動控制關(guān)鍵技術(shù)513.1開放式控制系統(tǒng)513.2實(shí)時控制6133控制性能測試71.3.4模塊化機(jī)器人技術(shù)81.4論文研究背景與意義91.5論文工作內(nèi)容與章節(jié)安排101.5.1論文主要工作內(nèi)容

15、101.5.2論文章節(jié)安排11第二章運(yùn)動控制與測試研究平臺設(shè)計122系統(tǒng)總體結(jié)構(gòu)分析122.1.1運(yùn)動控制系統(tǒng)體系結(jié)構(gòu)122.1.2系統(tǒng)總體結(jié)構(gòu)132.2測控系統(tǒng)平臺構(gòu)建14221總體架構(gòu)設(shè)計 142.2.2控制柜設(shè)計16223 KeMotion機(jī)器人控制器及配置1723模塊化關(guān)節(jié)設(shè)計192.3.1機(jī)器人的單關(guān)節(jié)控制測量模型192.3.2模塊化關(guān)節(jié)的組成202.3.3驅(qū)動系統(tǒng)選型及信號連接2123.4檢測編碼器的選擇222.4系統(tǒng)精度測試232.5本章小結(jié)24第三章基于高速伺服總線的測控系統(tǒng)通信研究253.1 SERCOS III協(xié)議及通信主站253.1.1 SERCOS III實(shí)時以太網(wǎng)協(xié)議

16、概述253.1.2 SERCOS III 通信狀態(tài)機(jī)263.13基于NetX的實(shí)時以太網(wǎng)主站273.1.4 NetX數(shù)據(jù)交互機(jī)制283.2系統(tǒng)結(jié)構(gòu)設(shè)計30in3.2.1研究平臺結(jié)構(gòu)303.2.2軟件開發(fā)總體結(jié)構(gòu)313.2.3 RTX實(shí)時性能測試323.3通信配置程序開發(fā)343.3.1通信建立總體流程343.3.2伺服從站配置353.3.3通信測試及分析363.4基于RTX的運(yùn)動控制程序開發(fā)363.4.1 RTX驅(qū)動程序363.4.2 RTX通信配置373.4.3伺服控制應(yīng)用程序開發(fā)：.383.5本章小結(jié)39第四章基于PCI總線運(yùn)動控制卡的機(jī)器人控制開發(fā)404.1基于MP-C154的機(jī)器人控制系

17、統(tǒng)404丄1 MP-C154功能及特點(diǎn)404.1.2系統(tǒng)總體結(jié)構(gòu)404.2 SCARA機(jī)器人運(yùn)動學(xué)分析414.2.1建立機(jī)器人坐標(biāo)系414.2.2機(jī)器人正向運(yùn)動學(xué)分析43423機(jī)器人逆運(yùn)動學(xué)分析44424機(jī)器人雅克比矩陣464.3 SCARA機(jī)器人控制系統(tǒng)總體設(shè)計47431軟件總體結(jié)構(gòu)4743.2多線程任務(wù)調(diào)度48433面向?qū)ο筇匦栽谲浖械膽?yīng)用494.3.4機(jī)器人姿態(tài)描述及數(shù)據(jù)結(jié)構(gòu)494.4主要功能模塊開發(fā)51441運(yùn)動學(xué)驗(yàn)證模塊514.4.2示教再現(xiàn)功能524.5小結(jié)53第五章測試采樣及分析系統(tǒng)開發(fā)545總體結(jié)構(gòu)設(shè)計545.1.1功能結(jié)構(gòu)及采樣系統(tǒng)545.1.2 OpenGL三維圖形仿真平

18、臺555.2機(jī)器人三維場景建模565.2.1基于OpcnGL的可視化開發(fā)流程565.2.2機(jī)器人DH坐標(biāo)系的實(shí)現(xiàn)58523機(jī)器人工作場景三維模型58524場景漫游功能及驗(yàn)證595.3機(jī)器人運(yùn)動規(guī)劃仿真測試605.3.1 T 型速度控制.:605.3.2直線插補(bǔ)6253.3圓弧插補(bǔ)645.4運(yùn)動控制性能測試66541性能測試流程665.4.2運(yùn)動性能集成測試675.5小結(jié)69第六章 總結(jié)與展望70致 謝72參考文獻(xiàn)73作者在攻讀碩士學(xué)位期間發(fā)表的論文和科研成果76v第一章緒論第一章緒論1.1引言機(jī)器人一詞起始于20世界六十年代，但一直沒有形成統(tǒng)一的定義，其中較 為實(shí)用的定義來自于H本工業(yè)機(jī)器人協(xié)

19、會(JIRA),即工業(yè)機(jī)器人是“一種裝備 有記憶裝置和末端執(zhí)行器的,能夠轉(zhuǎn)動并通過自動完成各種移動來代替人類勞動 的通用機(jī)器” ,o美國的英格伯格和德沃爾在1959年設(shè)計生產(chǎn)的第一臺工業(yè)機(jī) 器人拉開了機(jī)器人研究的序幕，并不斷取得技術(shù)突破和重大發(fā)展。目前，工業(yè)機(jī) 器人已成為最先實(shí)現(xiàn)產(chǎn)業(yè)化的機(jī)器人技術(shù)，并廣泛應(yīng)用在噴涂、焊接.搬運(yùn)及材 料加工等領(lǐng)域。工業(yè)機(jī)器人是集控制.計算機(jī)、設(shè)計制造.材料加工、信息和傳感等于一體 的復(fù)雜性、高新技術(shù)，其運(yùn)動控制系統(tǒng)更是整個系統(tǒng)的關(guān)鍵和核心.決定著機(jī)器 人的工作性能。但是隨著工業(yè)柔性化生產(chǎn)需求的增加及加工精度要求的提高，傳 統(tǒng)的機(jī)器人運(yùn)動控制系統(tǒng)應(yīng)用受到了很大的局

20、限。這些機(jī)器人控制系統(tǒng)大多采用 封閉式結(jié)構(gòu)，基于專用的硬件開發(fā)平臺，應(yīng)用軟件開發(fā)分別采用各自定義的專用 編程語言，系統(tǒng)間的交互方式及通訊機(jī)制也各不相同。由于各廠商控制系統(tǒng)的功 能模塊間互不兼容，給系統(tǒng)功能擴(kuò)展、平臺移植帶來了極大的不便，而且還增加 了系統(tǒng)的生產(chǎn)成本和維護(hù)難度。隨著市場競爭的加劇和技術(shù)進(jìn)步，這種結(jié)構(gòu)的控 制系統(tǒng)存在的固有缺陷會越來越明顯.將在一定程度上阻礙機(jī)器人產(chǎn)業(yè)的發(fā)展。 此外，在工業(yè)生產(chǎn)中廣泛應(yīng)用的高性能機(jī)器人運(yùn)動控制系統(tǒng)被國外幾大生產(chǎn)廠商 所壟斷，價格昂貴。為了推進(jìn)機(jī)器人運(yùn)動控制系統(tǒng)的自主研發(fā)，也為了更好的適 應(yīng)工業(yè)發(fā)展需求，通用化.標(biāo)準(zhǔn)化、高性能的機(jī)器人控制系統(tǒng)研究越來越

21、重要。開放式機(jī)器人運(yùn)動控制系統(tǒng)基于常規(guī)的計算機(jī)平臺和操作系統(tǒng)，利用標(biāo)準(zhǔn)的 開發(fā)語言及通信總線進(jìn)行軟件開發(fā)及數(shù)據(jù)傳輸，可以實(shí)現(xiàn)軟硬件不同平臺的移植 和功能擴(kuò)展，增強(qiáng)不同模塊間的互操作性。此外，為了促進(jìn)自主開發(fā)機(jī)器人運(yùn) 動控制系統(tǒng)的產(chǎn)品化和推廣應(yīng)用,需要對系統(tǒng)性能進(jìn)行嚴(yán)格測試。1.2機(jī)器人控制系統(tǒng)1.2.1機(jī)器人與多軸運(yùn)動控制在工業(yè)中廣泛應(yīng)用的關(guān)節(jié)型機(jī)器人又稱為機(jī)械手，是模仿人類腰部到手臂的 關(guān)節(jié)結(jié)構(gòu)進(jìn)行設(shè)計，主要包括底座.手臂.腕部及手部等。在驅(qū)動電機(jī)作用下, 各個關(guān)節(jié)軸通過機(jī)械傳動帶動工具手進(jìn)行空間作業(yè)，所以機(jī)器人控制系統(tǒng)是典型 的多軸運(yùn)動控制系統(tǒng)，如圖11。機(jī)器人控制系統(tǒng)可以分為運(yùn)動控制器.

22、關(guān)節(jié)驅(qū) 動系統(tǒng)及人機(jī)交互三部分組成。機(jī)器人運(yùn)動控制器控制著機(jī)器人的動作時間.運(yùn) 動軌跡.姿態(tài)等，通過復(fù)雜的運(yùn)算給定機(jī)器人各個關(guān)節(jié)軸的運(yùn)動信息，進(jìn)而有關(guān) 節(jié)驅(qū)動系統(tǒng)完成單個關(guān)節(jié)軸的閉環(huán)控制，而人機(jī)交互則是根據(jù)運(yùn)動控制系統(tǒng)提供 的運(yùn)動指令進(jìn)行應(yīng)用程序的開發(fā)，滿足機(jī)器人工作的需求。早期的機(jī)器人運(yùn)動控 制器功能比較簡單，能完成簡單的作業(yè)，但系統(tǒng)龐大、操作復(fù)雜.價格昂貴，而 且精度和可靠性也不高。隨著微電子、自動控制等技術(shù)的進(jìn)步，機(jī)器人控制器在 20世紀(jì)八十年代得到迅猛發(fā)展，其功能不斷完善，性能也不斷提髙。目前機(jī)器 人運(yùn)動控制器往往己具有人機(jī)交互、離線編程、運(yùn)動控制.系統(tǒng)診斷、狀態(tài)監(jiān)控、 通信等眾多功能

23、，而且控制器硬件強(qiáng)大的運(yùn)算能力及豐富資源乜提高了運(yùn)動控制 算法的性能，豐富了運(yùn)動控制算法的類型。圖機(jī)器人控制系統(tǒng)結(jié)構(gòu)機(jī)器人運(yùn)動控制器位于機(jī)器人控制系統(tǒng)結(jié)構(gòu)的最頂層，直接影響著機(jī)器人的 控制性能，其主要特點(diǎn)如下：1、多關(guān)節(jié)控制。為了進(jìn)行復(fù)雜的作業(yè)操作，工業(yè)機(jī)器人往往具有六個自由 度，即可以以任意姿態(tài)到達(dá)工作空間內(nèi)任意點(diǎn)。機(jī)器人屬于剛性結(jié)構(gòu)，前部關(guān)節(jié) 的運(yùn)動會堵響機(jī)器人后面關(guān)節(jié)的狀態(tài)。在機(jī)器人運(yùn)動過程中，耍求各個關(guān)節(jié)相互 協(xié)調(diào)與配合，進(jìn)而控制機(jī)器人手部到達(dá)期望位姿。2模型復(fù)雜。機(jī)器人的多自由度結(jié)構(gòu)決定了機(jī)器人數(shù)學(xué)模型的復(fù)雜性，其 數(shù)學(xué)模型具有非線性.多變量.耦合性及動態(tài)性等特點(diǎn)。因此在工業(yè)機(jī)器人的

24、控 制過程中不僅需要使用解耦.前饋、補(bǔ)償及自適應(yīng)等復(fù)雜的控制技術(shù)，還需要解 決控制的優(yōu)化及決策等問題。3. 運(yùn)算量大。為了控制機(jī)器人手部在空間的位姿，機(jī)器人運(yùn)動控制器往往 需要具有較高的運(yùn)算處理能力，進(jìn)行運(yùn)動控制過程中的運(yùn)動學(xué)及動力學(xué)運(yùn)算如復(fù) 雜的坐標(biāo)變換、矩陣、微積分運(yùn)算。4、運(yùn)動平穩(wěn)。在工業(yè)機(jī)器人工作過程中，主要是控制機(jī)器人工具手的運(yùn)動 軌跡及空間位姿，但同時需要保證機(jī)器人各關(guān)節(jié)運(yùn)動的平滑及穩(wěn)定，以免造成沖 擊和振動，加劇機(jī)械部件的磨損，減少機(jī)器人壽命。1.2.2國外機(jī)器人運(yùn)動控制系統(tǒng)研究與技術(shù)現(xiàn)狀機(jī)器人從誕生到發(fā)展至今，其研究經(jīng)過了示教再現(xiàn)機(jī)器人、離線編程機(jī)器人 及智能機(jī)器人三個階段。示

25、教再現(xiàn)機(jī)器人是最早的機(jī)器人編程方式.利用示教盒 控制機(jī)器人的運(yùn)動，進(jìn)而記錄機(jī)器人的運(yùn)動路徑及路徑點(diǎn)信息，在機(jī)器人自動再 現(xiàn)運(yùn)動過程時，對路徑信息進(jìn)行解析，并調(diào)用相關(guān)功能模塊完成連續(xù)運(yùn)動。離線 編程機(jī)器人是在計算機(jī)平臺上利用建立的機(jī)器人環(huán)境模型對路徑進(jìn)行規(guī)劃及算 法驗(yàn)證，并將離線編程代碼下載到機(jī)器人控制系統(tǒng)指示機(jī)器人運(yùn)動。智能機(jī)器人 是最新近的機(jī)器人控制方式，利用攝像頭、傳感器等外部設(shè)備獲得外部環(huán)境信息, 并用于判斷、推理和決策，進(jìn)而適時調(diào)整運(yùn)動狀態(tài)，更靈活的在復(fù)雜環(huán)境下工作。目前,國外的機(jī)器人生產(chǎn)和研究企業(yè)主要有ABB、KUKA、Delta Tau及KEBA 等，其機(jī)器人控制技術(shù)均處于世界領(lǐng)先

26、地位。奧地利KEBA公司生產(chǎn)的KeMotion 是基于數(shù)字總線通信的多軸運(yùn)動控制系統(tǒng)，采用模塊化結(jié)構(gòu)構(gòu)成一個完整的機(jī)器 人運(yùn)動控制系統(tǒng)如圖12所示，包括控制器、示教器、觸摸屏控制面板及與PC 機(jī)、伺服驅(qū)動器.外圍擴(kuò)展模塊等進(jìn)行通信的接口。電機(jī)動器外部擴(kuò)展模塊圖12 KeMotion控制系統(tǒng)KeMotion硬件平臺上運(yùn)行的是VxWorks實(shí)時操作系統(tǒng)，并在操作系統(tǒng)之上 同時運(yùn)行了 RC(Robot Control)和CoDeSysControl兩套應(yīng)用軟件卩同。RC系統(tǒng)負(fù) 責(zé)系統(tǒng)的運(yùn)動控制，并提供了 TcachTalk開發(fā)語言，可以在PC上利用TeachEdit 軟件進(jìn)行運(yùn)動控制功能開發(fā)。軟PL

27、C系統(tǒng)采用3S公司的CoDeSys平臺，具有 邏輯控制、總線通信、系統(tǒng)設(shè)置.機(jī)器人設(shè)置等功能，可以利用KeStudio軟件 進(jìn)行開發(fā)和設(shè)置。CoDeSys符合I EC 61131-3標(biāo)準(zhǔn)，并支持ST、LD等多種編程 語言及程序轉(zhuǎn)換。KeMotion可以通過局域網(wǎng)和PC機(jī)進(jìn)行通信，進(jìn)而完成程序的 下載.系統(tǒng)監(jiān)控及運(yùn)動變量狀態(tài)傳輸?shù)?。KeMotion技術(shù)成熟、性能穩(wěn)定，但是 價格昂貴。且在進(jìn)行應(yīng)用程序開發(fā)時，其專用的KA1R0、TeachTalk等開發(fā)語言 增加了系統(tǒng)開發(fā)的難度。此外，KeMotion各功能模塊間釆用KeBus專用總線通 信，無法與其他公司功能模塊進(jìn)行連接和替換。美國Delta T

28、au公司生產(chǎn)的PMAC是基于PC總線的多軸運(yùn)初控制器的代表， 同時具備邏輯控制及數(shù)據(jù)采集的功能，憑其強(qiáng)大的功能、高速的運(yùn)算速度及優(yōu)良 的運(yùn)動控制性能被廣泛應(yīng)用在數(shù)控及工業(yè)機(jī)器人控制中。PMAC釆用摩托羅拉 公司的DSP56K處理器，具有很強(qiáng)的計算能力,可以進(jìn)行算數(shù)、邏輯及關(guān)系運(yùn)算。 PMAC還集成了運(yùn)動控制.邏輯控制及10控制等功能，PLC穆序刷新周期小于 lOmso PMAC提供了 DPRAM.總線、串行及USB多種與PC通信的方式，并 且支持AT. PCI、PC-XT等總線類型，具有很好的平臺適應(yīng)性。通過提供的特 殊存儲區(qū)，用戶可以進(jìn)行運(yùn)動規(guī)劃開發(fā)并在PMAC系統(tǒng)上執(zhí)行，保證了系統(tǒng)的 實(shí)時

29、性。J比外，PMAC提供了豐富的軟件開發(fā)資源如PEWIN32 PRO編程調(diào)試軟 件、PCOM32 PRO上位機(jī)開發(fā)動態(tài)庫軟件.PMACHMI的人機(jī)開發(fā)軟件等。運(yùn) 動程序使用G代碼進(jìn)行開發(fā)，通過程序下載進(jìn)行執(zhí)行，并且有板卡決定程序的 運(yùn)行狀態(tài)。上位機(jī)程序使用Windows編程語言調(diào)用響應(yīng)函數(shù)接口實(shí)現(xiàn)，可以監(jiān) 視或者改變板卡的運(yùn)行狀態(tài)，并且開發(fā)良好的GUI交互界面。圖1 -3 PMAC PCI Lite運(yùn)動控制卡1.2.3國內(nèi)機(jī)器人運(yùn)動控制系統(tǒng)研究與技術(shù)現(xiàn)狀國內(nèi)機(jī)器人控制研究起步并不是很晚，在“七五國家科技攻關(guān)”計劃中就列 入了搬運(yùn)、焊接、噴涂等多個類型的工業(yè)機(jī)器人研究項(xiàng)目，國家八六三計劃又把 智

30、能機(jī)器人作為了一個重要的研究方向并投入大量的資金支持，在上世紀(jì)90年代 末國家更是投資建立了新松機(jī)器人公司.哈爾濱博實(shí)機(jī)器人公司、北京機(jī)械工業(yè) 自動化研究所機(jī)器人開發(fā)中心及奇瑞汽車股份有限公司機(jī)器人研發(fā)中心等多個 機(jī)器人科研和產(chǎn)業(yè)化基地，實(shí)現(xiàn)了高技術(shù)發(fā)展與產(chǎn)業(yè)發(fā)展的緊密結(jié)合。經(jīng)過多代 人的不懈努力國內(nèi)的機(jī)器人運(yùn)動控制研究也取得了不錯的成果。但和國外機(jī)器 人技術(shù)水平尚有較大差距，沒有擺脫對國外技術(shù)的絕對依賴。以奇瑞機(jī)器人系統(tǒng) 為例，機(jī)器人本體結(jié)構(gòu)由自己的研發(fā)團(tuán)隊(duì)完成，但減速機(jī)和伺服驅(qū)動器釆用的是 日本和奧地利的產(chǎn)品，很好地完成插補(bǔ).前饋的等功能，使工業(yè)機(jī)器人性能達(dá)到 國際同行標(biāo)準(zhǔn)。電控柜和示教器

31、均是自主研發(fā)，前者采用雙循環(huán)系統(tǒng)，可以在焊 接、沖壓等惡劣環(huán)境下適用；后者不但簡單美觀、而且操作簡單.功能齊全，已 經(jīng)申請國家專利。隨著計算機(jī).集成電路等技術(shù)的不斷突破和發(fā)展，為我國的機(jī)器人技術(shù)研究 提供了良好契機(jī)。首先在硬件結(jié)構(gòu)方面，ARM、DSP及Intel系列等計算能力強(qiáng)大 的通用微處理器被越來越多的用于機(jī)器人控制系統(tǒng)的開發(fā)，并可以采用集成 FPGA. CPLD等可編程器件的完整片上系統(tǒng)來滿足對接口的特殊需求，同時簡 化了電路設(shè)計并提高了性價比。其次在機(jī)器人體系結(jié)構(gòu)方面，傳統(tǒng)的劃分方法是 基于硬件層次結(jié)構(gòu)，如三菱重工株式會社把PA210結(jié)構(gòu)就劃分為五層；另外一種 是軟硬件功能統(tǒng)一考慮，這

32、是未來主要釆用的劃分方法，這可以使我國有可能參 與機(jī)器人相關(guān)標(biāo)準(zhǔn)的制定。在開發(fā)環(huán)境方面，ABB、KUKA等機(jī)器人公司均采用 各自的開發(fā)平臺及開發(fā)語言，為了便于程序的移植，目前有amBots. RobotFlow. ADE等提供源代碼的開發(fā)環(huán)境。基于上述平臺優(yōu)勢，我國學(xué)校及科研機(jī)構(gòu)進(jìn)行了 一系列研究。北京航空航天大學(xué)的吳鑫、齊鉗金、吳紅杰等人在國家“九五”預(yù)研項(xiàng)目支 持下，設(shè)計了基于CAN總線的弧焊機(jī)器人控制系統(tǒng)。在該控制系統(tǒng)中，PC通 過CAD文件導(dǎo)入機(jī)器人軌跡，結(jié)合CCD攝像機(jī)圖像獲収機(jī)器人空問位置坐標(biāo)并 進(jìn)行軌跡規(guī)劃，控制信息經(jīng)CAN總線接口卡傳遞給各機(jī)器人關(guān)節(jié)伺服驅(qū)動器。 在編碼器脈沖檢

33、測電路中，針對機(jī)器人啟動和停止時存在的失步和多步狀況進(jìn)行 了補(bǔ)償，提高了弧焊機(jī)器人的控制精度。哈爾濱大學(xué)的鄭劍飛在馮勇教授的指導(dǎo)下，利用徳州儀器的TMS320F240DSP設(shè)計了關(guān)節(jié)控制器，并采用485總線搭建了基于PC的分布式控制系統(tǒng)如圖14。 為了獲得關(guān)機(jī)的絕對位置，在傳動機(jī)構(gòu)末端安裝了霍爾傳感器兇。主計算機(jī)485總線傳動i 機(jī)構(gòu):檢測反饋驅(qū)検測反饋驅(qū)動;,關(guān)節(jié): 控制 器6 I圖14分布式控制系統(tǒng)1.3機(jī)器人運(yùn)動控制關(guān)鍵技術(shù)目前工業(yè)機(jī)器人技術(shù)已經(jīng)可以滿足一般工業(yè)應(yīng)用需求，隨著科學(xué)技術(shù)的不斷 進(jìn)，對機(jī)器人結(jié)構(gòu)、系統(tǒng)等的優(yōu)化日漸成為研究熱點(diǎn)。縱觀整個的機(jī)器人研究領(lǐng) 域，可見工業(yè)機(jī)器人研究技術(shù)

34、逐步在向開放化.模塊可重構(gòu)化、智能化.數(shù)字化 等方向發(fā)展，而且機(jī)器人控制測試技術(shù)也得到越來越多的重視和研究。1.3.1開放式控制系統(tǒng)傳統(tǒng)的機(jī)器人控制器采用各自獨(dú)立的系統(tǒng)架構(gòu)、硬件資源、編程語言及接口 等，開發(fā)、移植及替換難度較大，于是在20世紀(jì)80年代出現(xiàn)了開放式控制系統(tǒng) 的概念。開放式控制器可以實(shí)現(xiàn)機(jī)器人控制器的全部功能，但是開發(fā)平臺包括的 硬件和軟件資源必須是開放的、標(biāo)準(zhǔn)的、通用的。開放式機(jī)器人控制器的特點(diǎn)可 以概括為 以下幾 點(diǎn)1、移植性，裁植性指控制器軟件在不同硬件平臺上實(shí)現(xiàn)相同功能的能力。 要求在進(jìn)行系統(tǒng)平臺移植時，不需要對軟件模塊進(jìn)行大量修改就可以實(shí)現(xiàn)控制器 的全部功能，大大提髙了

35、系統(tǒng)的柔性。2、互操作性?；ゲ僮餍砸蟾鞴δ苣K組件之間協(xié)調(diào)工作，進(jìn)而組成一個 完整、復(fù)雜的功能系統(tǒng)。這種協(xié)作依賴于模塊之間的相互通信，為了便于不同廠 商功能模塊之間的替換，需要定義一系列的通用標(biāo)準(zhǔn)如 OSACA(Open System Architecture for Control Within Automation),模塊之間利用 標(biāo)準(zhǔn)系統(tǒng)接口獲得預(yù)期的系統(tǒng)功能。顯然，總線式設(shè)計是實(shí)現(xiàn)可互操作性的關(guān)鍵。3、可曠展性?？蓴U(kuò)展性指在應(yīng)用功能增加時，開放系統(tǒng)的功能通過增加系 統(tǒng)組件或者對系統(tǒng)組件進(jìn)行升級便可滿足系統(tǒng)需求。這樣可以避免重新設(shè)計或者 購買整個系統(tǒng)，減少了系統(tǒng)成本投入和資源浪費(fèi)。4、

36、易獲得性。易獲得性是指系統(tǒng)的軟硬件平臺應(yīng)采用通用的系統(tǒng)資源，即 應(yīng)有多個廠商進(jìn)行生產(chǎn)或提供性能相似的標(biāo)準(zhǔn)化產(chǎn)品。這不僅可以降低系統(tǒng)擴(kuò)展 和開發(fā)的難度，而且可以避免對單一廠商產(chǎn)品的依賴，有利于系統(tǒng)功能的完善和 提高。5第一章緒論目前開放式控制系統(tǒng)平臺研究雖然取得了一定的成果，但仍處于研究階段尚 未形成統(tǒng)一的標(biāo)準(zhǔn)，目前影響較大的是OSACAI。應(yīng)用 軟件硬件17第一章緒論OSACA有歐洲Bosch、Index. CIMCBT等22家控制器、機(jī)床廠商及研究機(jī)構(gòu) 等在1990年聯(lián)合提出和推廣，旨在制定能廣泛應(yīng)用于工業(yè)控制器，并與硬件系 統(tǒng)相互獨(dú)立的開放式體系結(jié)構(gòu)標(biāo)準(zhǔn)，進(jìn)而提高控制系統(tǒng)柔性，并提高產(chǎn)品在

37、世界 范圍內(nèi)的競爭力。OSACA系統(tǒng)結(jié)構(gòu)如圖1-5所示，主要包括應(yīng)用軟件、系統(tǒng)軟件及硬件三層。 應(yīng)用軟件層主要進(jìn)行系統(tǒng)的業(yè)務(wù)邏輯控制，有一系列功能獨(dú)立的結(jié)構(gòu)對象模塊 A0(Architecture Object)組成。A0模塊具有平臺無關(guān)性，相互之間是松耦合的關(guān) 系，因此功能不同的控制系統(tǒng)可以根據(jù)具體需要靈活添加A0模塊，并使不同開 發(fā)者的功能模塊協(xié)調(diào)工作。系統(tǒng)軟件主要包括操作系統(tǒng).通信系統(tǒng)、配置系統(tǒng)等， 分別用于實(shí)現(xiàn)系統(tǒng)的資源管理.信息交換及AO模塊處理，標(biāo)準(zhǔn)API是應(yīng)用軟件 層訪問.系統(tǒng)層的唯一途徑，隱藏了系統(tǒng)層的內(nèi)部實(shí)現(xiàn)并保證了控制系統(tǒng)的平臺 無關(guān)性，提髙了系統(tǒng)的可移植性.擴(kuò)展性.互操作

38、性及互換性。系統(tǒng)硬件是系統(tǒng) 運(yùn)行的基礎(chǔ)，包括CPU主板及各種輸入輸出設(shè)備等部件，通過驅(qū)動程序和系統(tǒng) 關(guān)聯(lián)。OSACA模型的準(zhǔn)則就是模塊化、可裝配及開放式，即在標(biāo)準(zhǔn)平臺上建立由 可以自由組合的模塊組組成的系統(tǒng)，是目前OMAC. OSEC等眾多開放式控制器 規(guī)范研究中的最理想化模型。132實(shí)時徑制對控制系統(tǒng)來說，實(shí)時性的含義不僅是指“快”，更是指時間的可預(yù)測性, 即要求對事件的處理在準(zhǔn)確的時間段內(nèi)完成。換言之，即使對事件的處理流程邏 輯上是正確的，一旦不能在規(guī)定的時間內(nèi)完成對事物的處理，也會給控制系統(tǒng)帶 來巨大偏差及影響。機(jī)器人控制系統(tǒng)包含大量的實(shí)時任務(wù)如軌跡插補(bǔ)、關(guān)節(jié)控制、 外部急停等，實(shí)時性是

39、衡量機(jī)器人控制器性能的一個重要指標(biāo)彩響系統(tǒng)實(shí)時性 的因素主要由以下幾個方面(：K硬件架構(gòu)控制系統(tǒng)便件性能從根本上決定了系統(tǒng)的運(yùn)行速度。單PC系統(tǒng)架構(gòu)的運(yùn)動 控制系統(tǒng)可以盡可能的滿足開放性的需求，但是控制系統(tǒng)的所有任務(wù)都有一個微 處理器進(jìn)行處理和調(diào)度，對硬件性能要求非常髙。當(dāng)控制任務(wù)增多時，不但增加 了系統(tǒng)管理的難度，還有可能增加實(shí)時任務(wù)的響應(yīng)時間。而分級式的架構(gòu)，則可 以將實(shí)時與非實(shí)時任務(wù)處理分到上、位機(jī)和下位機(jī)控制器，使系統(tǒng)結(jié)構(gòu)更加合理. 實(shí)時性得到更好地滿足。2、操作系統(tǒng)控制系統(tǒng)軟件是在操作系統(tǒng)之上進(jìn)行開發(fā)并運(yùn)行，有其進(jìn)行任務(wù)調(diào)度.資源 分配及協(xié)調(diào)通信等，所以操作系統(tǒng)性能對機(jī)器人控制系統(tǒng)實(shí)

40、時性影響也非常重大。 操作系統(tǒng)為了實(shí)現(xiàn)對實(shí)時任務(wù)的支持，可以使用下面三種方法：直接采用 Vxworks. QNX等實(shí)時操作系統(tǒng)，但這種操作系統(tǒng)的開發(fā)工具和軟件較少；對非 實(shí)時操作系統(tǒng)內(nèi)核進(jìn)行編程，進(jìn)而提高系統(tǒng)實(shí)時性，開發(fā)難度及工作量較大；采 用進(jìn)行了實(shí)時性擴(kuò)展的通用操作系統(tǒng)如RTLinux. Windows+RTX等，既可以滿 足實(shí)時性要求，又可以充分發(fā)揮通用操作系統(tǒng)的資源優(yōu)勢,3,|,4103、通信協(xié)議機(jī)器人控制器要將控制信號發(fā)給下位機(jī)控制器或伺服系統(tǒng)，隨著伺服數(shù)量的 增多及工藝要求的提高，對通信性能要求也越來越高。在一般工業(yè)機(jī)器人控制中， 實(shí)時響應(yīng)時間要求為510ms,對于高性能的同步運(yùn)動

41、控制響應(yīng)時間甚至要求小 于1ms（，這就需要采用EtherCAT、SERCOS III等實(shí)時以太網(wǎng)協(xié)議進(jìn)行通信。1.33控制性能測試為了推進(jìn)機(jī)器人技術(shù)的提高和推廣應(yīng)用,需要對機(jī)器人控制進(jìn)行定位精度. 重復(fù)定位精度及軌跡精度等的測量分析,ISO/DIS 9283【制定了機(jī)器人性能測試 的標(biāo)準(zhǔn)和方法。機(jī)器人運(yùn)動參數(shù)的測量是性能參數(shù)量化的重要依據(jù)，目前在國內(nèi) 外研究中用于測量運(yùn)動參數(shù)的方法有很多如經(jīng)緯儀三角測量法、光學(xué)三角測量法. 激光跟蹤測量法.雙攝像機(jī)測量法.接近測量法、參考軌跡測量法、三坐標(biāo)測量 法等.主要可以分為接觸式測最和非接觸式測量兩類.機(jī)械隨動系統(tǒng)是典型的接觸式測量，圖16是機(jī)器人研究

42、所的張超群.鄧喜 君等人在早期設(shè)計的機(jī)械隨動式測量系統(tǒng)實(shí)現(xiàn)方案2】。該系統(tǒng)有機(jī)器人控制 系統(tǒng).實(shí)際被控機(jī)器人、測量機(jī)器人、碼盤信號檢測接口及測試分析用的PC組 成。測量機(jī)器人是采用連桿機(jī)構(gòu)原理設(shè)計的六自由度測試系統(tǒng)，本身不帶有驅(qū)動 系統(tǒng)，并且在機(jī)器人的各個關(guān)節(jié)安裝了奇分辨率檢測編碼器，和被控機(jī)器人之間 釆用機(jī)械連接。當(dāng)被控機(jī)器人根據(jù)控制系統(tǒng)命令進(jìn)行運(yùn)動時，測量機(jī)器人跟隨一 起運(yùn)動，并將運(yùn)動信息通過檢測編碼器傳給PC分析系統(tǒng)。PC不僅可以利用反 饋信息進(jìn)行關(guān)節(jié)運(yùn)動參數(shù)分析，還可通過計算獲得工具手運(yùn)動軌跡及速度等參數(shù)。機(jī)器人控制系統(tǒng)實(shí)際控制機(jī)器人J測辰機(jī)人測試分析計舁機(jī)圖16機(jī)械隨動式測量系統(tǒng)在非

43、接觸式測量中常采用的技術(shù)有激光2叭紅外及超聲波3等。激光的釆樣 速率和精度都很奇，但是由于其定向性好，需要利用高性能跟蹤機(jī)構(gòu)才能實(shí)現(xiàn)三 維空間的測量，通常用于機(jī)器人標(biāo)定。在使用紅外線時，通常需要在機(jī)器人工具 手固定紅外發(fā)光二極管，并利用CCD攝像機(jī)實(shí)現(xiàn)空間位置測量。這種方法往往 對圖像數(shù)據(jù)處理能力要求較高，清華大學(xué)的歲波、都東等人基于立體視覺理論， 采用兩臺同定攝像機(jī)，根據(jù)直線特征匹配實(shí)現(xiàn)了工具手空間位姿的檢測卩鐵 超 聲法的測量精度和速度相對較低，但是可以對機(jī)器人工具手位姿進(jìn)行全方位測量, 而且成本較低。1.3.4模塊化機(jī)器人技術(shù)模塊化機(jī)器人技術(shù)是機(jī)器人本體設(shè)計的一種創(chuàng)新方法，是基于搭積木的

44、原理, 通過將不同參數(shù).不同性能的模塊組合，制造針對不同應(yīng)用的多種機(jī)器人）。但 模塊化機(jī)器人并不是一個全新的概念，早在上世紀(jì)80年德國斯圖加特大學(xué)就提 出了模塊化機(jī)器人系統(tǒng)。但美國卡內(nèi)基梅隆大學(xué)研制RMMS系統(tǒng)可以稱為第一 臺模塊化機(jī)器人，因?yàn)樗媚K化關(guān)節(jié)及連桿實(shí)現(xiàn)了機(jī)器人的機(jī)械重構(gòu)，而且 基于人的軟件設(shè)計方法也使得機(jī)器人應(yīng)用軟件可以重構(gòu)。其后隨著機(jī)器人在工業(yè) 應(yīng)用領(lǐng)域應(yīng)用中的競爭愈演愈烈，模塊化機(jī)器人技術(shù)也引起了越來越多國家和科 研機(jī)構(gòu)的關(guān)注和重視，并得到了大量的科研投入。目前取得了一系列的優(yōu)秀研究 成果，如日本的科學(xué)家Fukuda等人受生物體細(xì)胞組成的啟發(fā)，設(shè)計的CEBOT （基于細(xì)胞

45、結(jié)構(gòu)單元的自組織機(jī)器人）；Castano設(shè)計的Conro模塊化機(jī)器人； Murata等人的M-TRAN機(jī)器人系統(tǒng)，加拿大ESI公司生產(chǎn)的MMR模塊化機(jī)器 人等。圖17圖MRR模塊化關(guān)機(jī)及可重構(gòu)機(jī)器人雖然匡內(nèi)對模塊化機(jī)器人的研究較國外晚，但也取得了一些研究成果，如北 京郵電大學(xué)使用三個模塊化雙關(guān)機(jī)及兩個連桿模塊構(gòu)造了六自由度空間機(jī)械臂; 哈爾濱工業(yè)大學(xué)設(shè)計出了 HitMSRI自重構(gòu)機(jī)器人；北京控制工程研究所研發(fā)了 一體化關(guān)節(jié)，并成功應(yīng)用于烽火號衛(wèi)星；上海廣茂達(dá)公司研發(fā)的AS-MRobot模 塊化機(jī)器人等。19東南大學(xué)碩士學(xué)位論文圖18 AS-MRobotE模塊化機(jī)器人和傳統(tǒng)機(jī)器人相比，這種模塊化

46、機(jī)器人技術(shù)具有顯著的優(yōu)點(diǎn)甸：1. 模塊化機(jī)器人的重構(gòu)型好，通用性強(qiáng)。在模塊化機(jī)器人裝配過程中，可 以根據(jù)不同的應(yīng)用需求，使用模塊化關(guān)節(jié)靈活搭配不同構(gòu)性的機(jī)器人。較高的經(jīng) 濟(jì)效益必將拓展機(jī)器人的應(yīng)用領(lǐng)域，這必將為機(jī)器人技術(shù)的研究提供更大的市場 需求推動。2. 降低了機(jī)器人研發(fā)的復(fù)雜度，提高機(jī)器人生產(chǎn)、制作的效率。大規(guī)模標(biāo) 準(zhǔn)化關(guān)節(jié)的生產(chǎn)簡化了機(jī)器人設(shè)計工作，這將大大縮短機(jī)器人研發(fā)周期。模塊化 的設(shè)計有利于發(fā)揮各領(lǐng)域的優(yōu)勢，這又將促進(jìn)產(chǎn)品的優(yōu)化與更新。3. 使得機(jī)器人的維修更加簡單便利。模塊化關(guān)節(jié)的使用及大量生產(chǎn)，使得 當(dāng)機(jī)器人出現(xiàn)故障時，只需要丟棄出現(xiàn)故障的模塊化關(guān)節(jié)，釆用新的模塊化關(guān)節(jié)。 有些

47、智能化的機(jī)器人甚至可以白我維修，完成損壞關(guān)節(jié)的更換4. 模塊化機(jī)器人技術(shù)有利于推進(jìn)機(jī)器人產(chǎn)業(yè)的形成和發(fā)展。雖然機(jī)器人在 工業(yè)中的應(yīng)用越來越廣，但是目前存在機(jī)器人種類繁多、零部件通用性差.機(jī)器 人成本高、設(shè)計生產(chǎn)周期長等因素，而標(biāo)準(zhǔn)化、通用化的模塊億機(jī)器人技術(shù)，很 好的解決了機(jī)器人產(chǎn)業(yè)形成的障礙。1.4論文研究背景與意義機(jī)器人不但代替人類進(jìn)行危險、繁重、重復(fù)性作業(yè)，而且具有更奇的生成效 率、產(chǎn)品質(zhì)量及可控性，目前已廣泛應(yīng)用在噴涂.焊接、搬運(yùn)及材料加工等諸多 領(lǐng)域。據(jù)美國電氣和電子工程師協(xié)會(IEEE)統(tǒng)計，2008年底世界各國運(yùn)行的 機(jī)器人總數(shù)就已超100萬臺。受產(chǎn)業(yè)機(jī)構(gòu)升級、市場競爭程度加劇、

48、柔性化生產(chǎn) 需求增加.勞動力成本提髙及機(jī)器人技術(shù)推廣等諸多因素的影響，勞動密集型行 業(yè)的機(jī)器人密度將會繼續(xù)不斷提高。在未來十年，預(yù)計工業(yè)機(jī)器人將以每年10% 的速度遞增。我國機(jī)器人應(yīng)用起步較晚但增長迅速，2000年僅為550臺，到2010 年增長量已達(dá)到14978臺【2役我國作為工業(yè)生產(chǎn)大國，有望成為全球擁有機(jī)器 人數(shù)量最多的國家。面對機(jī)器人昂貴的價格及巨大的應(yīng)用市場和利潤空間，機(jī)器 人系統(tǒng)的優(yōu)化和自主研發(fā)就變得越來越塑要。在整個機(jī)器人系統(tǒng)中，控制系統(tǒng)是其最主要的部件，控制著整個系統(tǒng)的運(yùn)轉(zhuǎn), 猶如計算機(jī)系統(tǒng)的CPU；而有驅(qū)動電機(jī)和傳動裝置組成的機(jī)器人本體其價格成 本只占了較小的一部分，如在東南

49、大學(xué)和華恒焊接公司合作開發(fā)的噴涂機(jī)器人系 統(tǒng)中，本體投入占總成本的比例還不足15%I26L對于機(jī)器人控制高新技術(shù)，我 國也有越來越多的科研院所、高校實(shí)驗(yàn)室及相關(guān)企業(yè)進(jìn)入研究行列。雖然目前我 國已設(shè)計開發(fā)了一系列的機(jī)器人控制系統(tǒng)，但總體來說技術(shù)尚不成熟，性能.穩(wěn) 定性等也和國外有一定差距。為了推動我國機(jī)器人技術(shù)的進(jìn)步.早日實(shí)現(xiàn)我國機(jī) 器人的產(chǎn)業(yè)化，就迫切需要我們后來人繼續(xù)努力進(jìn)行機(jī)器人控制相關(guān)技術(shù)的學(xué)習(xí)、 研究及開發(fā)，并通過性能測試及對比發(fā)現(xiàn)不足，推動技術(shù)進(jìn)步。本文針對國產(chǎn)化機(jī)器人控制系統(tǒng)研究背景，以開放式機(jī)器人運(yùn)動控制研究及 性能測試為目標(biāo)，進(jìn)行系統(tǒng)方案設(shè)計及研究開發(fā)。本文結(jié)合KeMotion

50、等先進(jìn)控 制器和開放式控制器的特點(diǎn)，采用模塊化關(guān)節(jié)技術(shù)在短時間內(nèi)搭建了系統(tǒng)硬件平 臺。在系統(tǒng)平臺之上，對基于高速以太網(wǎng)的開放式運(yùn)動控制系統(tǒng)和基于PCI運(yùn)動 控制卡的機(jī)器人控制系統(tǒng)進(jìn)行了深入研究，并基于系統(tǒng)硬件平臺，進(jìn)行了測試系 統(tǒng)開發(fā)，構(gòu)建了完整的機(jī)器人運(yùn)動控制與測試平臺，為自主開發(fā)高性能的機(jī)器人 運(yùn)動控制系統(tǒng)打下了堅實(shí)基礎(chǔ)。1.5論文工作內(nèi)容與章節(jié)安排151論文主要工作內(nèi)容本論文首先根據(jù)系統(tǒng)運(yùn)動控制與性能測試功能的需要，結(jié)合模塊化技術(shù)、伺 服驅(qū)動技術(shù)，進(jìn)行機(jī)器人測控系統(tǒng)驗(yàn)證平臺設(shè)計。在該平臺基礎(chǔ)上，利用設(shè)計的 SERCOS III主站，通過引入RTX實(shí)時擴(kuò)展系統(tǒng)及驅(qū)動程序開發(fā)，實(shí)現(xiàn)了 PC主

51、 站對伺服系統(tǒng)的控制，為基于高速以太網(wǎng)的開放式運(yùn)動控制與測試系統(tǒng)開發(fā)奠定 了基礎(chǔ)。進(jìn)行了 SCARA機(jī)器人進(jìn)行運(yùn)動學(xué)分析，結(jié)合我國較為成熟的多軸運(yùn)動 控制卡技術(shù)，進(jìn)行了開放式機(jī)器人控制系統(tǒng)的開發(fā)。為了分析開放式控制系統(tǒng)的 性能，構(gòu)建了包含三維仿真功能的測試系統(tǒng)平臺。具體工作內(nèi)容有：K分析了目前機(jī)器人控制系統(tǒng)的架構(gòu)方式及特點(diǎn)，設(shè)計運(yùn)動控制與測試研 究的總體方案。推導(dǎo)模塊化關(guān)節(jié)的數(shù)學(xué)模型，研究其在本系統(tǒng)中應(yīng)用的合理性。 分別針對脈沖控制伺服系統(tǒng)和數(shù)字總線驅(qū)動系統(tǒng)進(jìn)行器件選型，完成12個模塊 化關(guān)節(jié)及其電器系統(tǒng)的設(shè)計，進(jìn)而完成測控系統(tǒng)驗(yàn)證平臺的設(shè)計。進(jìn)行系統(tǒng)的配 置和調(diào)試，并完成系統(tǒng)測量精度的評估。

52、2、針對基于高速以太網(wǎng)通信的運(yùn)動控制系統(tǒng)研究，分析了 NetX500網(wǎng)絡(luò)控 制器通信機(jī)制并設(shè)計了 SERCOS III協(xié)議通信主站，通過對DPM進(jìn)行合理劃分， 實(shí)現(xiàn)Windows下通信配置程序開發(fā)。搭建基于RTX的運(yùn)動控制平臺，對RTX 實(shí)時性能進(jìn)行分析，通過驅(qū)動開發(fā)及加載配置文件，建立實(shí)時周期性通信，實(shí)現(xiàn) 對伺服驅(qū)動的穩(wěn)定控制，并利用截取的通信報文分析了通信性能。3、采用D-H法建立SCARA機(jī)器人坐標(biāo)系，求解機(jī)器人運(yùn)動學(xué)正逆解及用 于速度分析的雅克比矩陣。在此基礎(chǔ)上，針對基本機(jī)器人應(yīng)用，利用MP-C154 運(yùn)動控制卡設(shè)計并開發(fā)SCARA機(jī)器人開放式控制系統(tǒng)，包含參數(shù)設(shè)置、示教再 現(xiàn)、狀態(tài)監(jiān)

53、控等功能模塊開發(fā)。4、基于系統(tǒng)碩件平臺，合理設(shè)計了測試采樣與分析系統(tǒng)的總體功能結(jié)構(gòu)， 分析了系統(tǒng)高精度采樣的實(shí)現(xiàn)方法。釆用OpenGL圖形開發(fā)庫，設(shè)計了用于仿真 機(jī)器人三維空間運(yùn)動的可視化平臺，該平臺包括場景漫游、運(yùn)動狀態(tài)監(jiān)控及曲線 顯示等功能。在此基礎(chǔ)上，實(shí)現(xiàn)了機(jī)器人速度.直線、圓弧的運(yùn)動規(guī)劃及仿真測 試，并對SCARA開放式機(jī)器人控制系統(tǒng)運(yùn)動性能進(jìn)行了評估。11第一章緒論1.5.2論文章節(jié)安排本文共分為六章，章節(jié)主要內(nèi)容如下：第一章緒論，首先分析了機(jī)器人運(yùn)動控制系統(tǒng)在應(yīng)用中存在的問題，介紹了 機(jī)器人運(yùn)動控制系統(tǒng)及國內(nèi)外發(fā)展現(xiàn)狀，隨后分析了機(jī)器人運(yùn)動控制研究的關(guān)鍵 技術(shù)，最后介紹了系統(tǒng)的研究

54、背最、意義及主要工作內(nèi)容。笫二章運(yùn)動控制與測試研究平臺設(shè)計，首先分析了 KeMotion專用控制器和 開放式控制器的特點(diǎn)，給出了運(yùn)動控制開發(fā)與測試研究的總體實(shí)現(xiàn)方案。基于推 導(dǎo)的模塊化關(guān)節(jié)數(shù)學(xué)模型，設(shè)計了集運(yùn)動控制與測試于一體的硬件平臺，介紹了 系統(tǒng)應(yīng)用配置及接口設(shè)計，并進(jìn)行了系統(tǒng)精度測量及分析。第三章基于高速總線的測控系統(tǒng)通信研究，本章首先分析了 SERCOS III協(xié) 議的特點(diǎn)，研究了基于NetX的主站設(shè)計及通信交互機(jī)制，利用CIFX50-RE通信 板卡構(gòu)建SERCOS III通信主站，并給出了基于SERCOS III的運(yùn)動控制與測試方 案，通過引入RTX實(shí)施擴(kuò)展內(nèi)核.驅(qū)動開發(fā)及Windo

55、ws平臺下的參數(shù)配置，實(shí) 現(xiàn)了 PC對伺服驅(qū)動系統(tǒng)的運(yùn)動控制，并進(jìn)行了通信報文分析，同時為基于高速 總線的運(yùn)動控制算法實(shí)驗(yàn)提供了便利接口。第四章基于PCI總線運(yùn)動控制卡的機(jī)器人控制開發(fā)，首先介紹了 MP-C154 的功能特點(diǎn)及機(jī)器人控制系統(tǒng)總體結(jié)構(gòu)，在給出SCARA機(jī)器人的運(yùn)動學(xué)分析基 礎(chǔ)上，進(jìn)行了 SCARA機(jī)器人開放式運(yùn)動控制系統(tǒng)開發(fā)，并詳細(xì)論述了系統(tǒng)主要 開發(fā)技術(shù)的應(yīng)用及參數(shù)設(shè)置、運(yùn)動學(xué)計算、示教再現(xiàn)等模塊的實(shí)現(xiàn)。第五章測試采樣及分析系統(tǒng)開發(fā)，首先介紹系統(tǒng)的功能組成，及基于系統(tǒng)硬 件平臺的采樣機(jī)制。介紹了 OpenGL圖形開發(fā)的優(yōu)勢并設(shè)計了包括機(jī)器人關(guān)節(jié)構(gòu) 件、DH坐標(biāo)系、視圖漫游功能的

56、機(jī)器人三維仿真平臺。進(jìn)而實(shí)現(xiàn)了機(jī)器人速度. 直線、圓弧等軌跡插補(bǔ)的仿真，完成了測控系統(tǒng)集成及SCARA機(jī)器人運(yùn)動控制 系統(tǒng)性能測試評估。第六章總結(jié)與展望，總結(jié)了系統(tǒng)已經(jīng)完成的工作，并對后續(xù)研究工作進(jìn)行了 分析與展望。#第二章運(yùn)動控制與測試研究平臺設(shè)計13第二章運(yùn)動控制與測試研究平臺設(shè)計第二章運(yùn)動控制與測試研究平臺設(shè)計機(jī)器人運(yùn)動控制研究與測試系統(tǒng)平臺主要有運(yùn)動控制系統(tǒng)、測試系統(tǒng)及測控 系統(tǒng)驗(yàn)證平臺三部分組成。本章主要對系統(tǒng)總體構(gòu)架進(jìn)行設(shè)計，并進(jìn)行運(yùn)行硬件 平臺的開發(fā)和可行性驗(yàn)證，為開放式運(yùn)動控制系統(tǒng)的開發(fā)與性能測試提供良好的 硬件支撐。2.1系統(tǒng)總體結(jié)構(gòu)分析2.1.1運(yùn)動控制系統(tǒng)體系結(jié)構(gòu)控制系統(tǒng)

57、是工業(yè)機(jī)器人的大腦，控制著機(jī)器人的協(xié)調(diào)運(yùn)動，基于國外的先進(jìn) 運(yùn)動控制系統(tǒng)進(jìn)行二次開發(fā)和自主開發(fā)開放式運(yùn)動控制系統(tǒng)是目前工業(yè)機(jī)器人 的控制系統(tǒng)架構(gòu)的兩種主要方式，有東南大學(xué)和華恒焊接設(shè)備有限公司聯(lián)合研發(fā) 的昆山一號焊接機(jī)器人系統(tǒng)就是KeMotion控制系統(tǒng)二次開發(fā)的成功用例。FavorrtttMovtffltnCStomgsSystem FuncbcnsFkw 0«oUolSOodules“外9畑CinctlSpm(a)應(yīng)用開發(fā)指令集:» A fam(b) Scope仿真軟件圖21 KeMotion指令集及仿真軟件在昆山一號機(jī)器人控制系統(tǒng)中，通過采用KeMotion控制系統(tǒng)并根據(jù)焊接功 能需求擴(kuò)展I/O. CAN總線通信及示教盒終端等模塊，可以很方便的完成焊接機(jī) 器人控制系統(tǒng)的搭建。釆用KeMotion控制系統(tǒng)的軟PLC模塊實(shí)現(xiàn)系統(tǒng)的邏輯控 制，并利用擴(kuò)展的RC Interface接口和RC模塊通信。RC模塊封裝了系統(tǒng)的運(yùn)動 控制功能，KeMotion實(shí)現(xiàn)了 PTP、直線.圓弧.歸零等運(yùn)動控制