本文關(guān)鍵詞：提高串聯(lián)機(jī)械臂運(yùn)動(dòng)精度的關(guān)鍵技術(shù)研究，由筆耕文化傳播整理發(fā)布。

第三章機(jī)械臂運(yùn)動(dòng)軌跡規(guī)劃與控制系統(tǒng)研制；完成其關(guān)節(jié)空間內(nèi)的軌跡規(guī)劃，將各關(guān)節(jié)變量值傳輸至；圖３．１４串聯(lián)機(jī)械臂控制框圖；為了實(shí)現(xiàn)機(jī)械臂末端執(zhí)行器的精確定位，采用直流伺服；第三章機(jī)械臂運(yùn)動(dòng)軌跡規(guī)劃與控制系統(tǒng)研制；圖３．１５機(jī)械臂控制系統(tǒng)的硬件結(jié)構(gòu)；機(jī)械臂控制系統(tǒng)主控制器采用平望科技公司提供的３．；伺服控制級的核心是美國ＤＥＬＴＡＴＡＵ公司研發(fā)的；采用Ｃｏｐｌｅ

第三章機(jī)械臂運(yùn)動(dòng)軌跡規(guī)劃與控制系統(tǒng)研制

完成其關(guān)節(jié)空間內(nèi)的軌跡規(guī)劃，將各關(guān)節(jié)變量值傳輸至多軸運(yùn)動(dòng)控制卡，控制各個(gè)關(guān)節(jié)電機(jī)驅(qū)動(dòng)器，實(shí)現(xiàn)各關(guān)節(jié)的位置伺服控制，從而完成給定的目標(biāo)任務(wù)。

體

圖３．１４串聯(lián)機(jī)械臂控制框圖

為了實(shí)現(xiàn)機(jī)械臂末端執(zhí)行器的精確定位，采用直流伺服電機(jī)、可編程多軸運(yùn)動(dòng)控制卡（Ｐｒｏｇｒａｍｍａｂｌｅｍｕｌｔｉｐｌｅａｘｉｓｃｏｎｔｒｏｌｌｅｒ，簡稱ＰＭＡＣ）和基于ＣＡＮ總線的嵌入式計(jì)算機(jī)構(gòu)建機(jī)械臂控制系統(tǒng)的硬件結(jié)構(gòu)，其結(jié)構(gòu)如圖３。１５所示。六自由度串聯(lián)機(jī)械臂控制系統(tǒng)采用雙微機(jī)分層控制方式，上層為規(guī)劃控制級，由嵌入式計(jì)算機(jī)負(fù)責(zé)系統(tǒng)管理、運(yùn)動(dòng)學(xué)計(jì)算、軌跡規(guī)劃、主控邏輯等。它通過ＣＡＮ總線與下層伺服控制級的多軸運(yùn)動(dòng)控制器等模塊通信。下層為伺服控制級，它主要由多軸運(yùn)動(dòng)控制器、直流伺服電機(jī)驅(qū)動(dòng)器及通信接口組成。其中，多軸運(yùn)動(dòng)控制器與直流伺服電機(jī)驅(qū)動(dòng)器一起完成直流伺服電機(jī)的位置、速度、力矩的閉環(huán)控制，實(shí)現(xiàn)了機(jī)械臂關(guān)節(jié)運(yùn)動(dòng)的實(shí)時(shí)控制。采用ＣＡＮ總線接口讀取并傳輸電機(jī)編碼器的初始值。為提高嵌入式ＰＣ與ＰＭＡＣ卡之間數(shù)據(jù)交換的速度，采用雙端口ＲＡＭ作為嵌入式ＰＣ與ＰＭＡＣ通訊的高速緩沖區(qū)，可將嵌入式ＰＣ內(nèi)存中的軌跡規(guī)劃的數(shù)據(jù)下載到ＰＭＡＣ，或?qū)㈥P(guān)節(jié)位置的信息和伺服單元的狀態(tài)信息傳輸至嵌入式ＰＣ。控制系統(tǒng)采用開放式控制結(jié)構(gòu)，配備了多種網(wǎng)絡(luò)接口，可通過ＣＡＮ總線與老人服務(wù)機(jī)器人的視覺、底盤、語音等其它單元通訊。由于機(jī)械臂的系統(tǒng)架構(gòu)具有控制系統(tǒng)開放及層次耦合少等優(yōu)點(diǎn)，它既可以作為獨(dú)立的串聯(lián)機(jī)械臂系統(tǒng)，也可以通過通訊接口擴(kuò)展為服務(wù)機(jī)器人的執(zhí)行單元。５５

第三章機(jī)械臂運(yùn)動(dòng)軌跡規(guī)劃與控制系統(tǒng)研制

翟

圖３．１５機(jī)械臂控制系統(tǒng)的硬件結(jié)構(gòu)

機(jī)械臂控制系統(tǒng)主控制器采用平望科技公司提供的３．５英寸嵌入式工控主板，它采用凌動(dòng)Ｎ２７０處理器，配備了多種的開放式接口。采用直流１２Ｖ和５Ｖ供電，功耗較低，穩(wěn)定性較高。主控制器采用ｗｉｎｄｏｗｓＸＰ作為操作系統(tǒng)，可方便安裝ＰＭＡＣ卡的驅(qū)動(dòng)程序及動(dòng)態(tài)鏈接庫。

伺服控制級的核心是美國ＤＥＬＴＡＴＡＵ公司研發(fā)的可編程多軸運(yùn)動(dòng)控制器。它是基于ＤＳＰ的多軸、多通道的運(yùn)動(dòng)控制器，同時(shí)具備ＰＬＣ控制、數(shù)據(jù)采集等功能。它的優(yōu)勢在于編程簡單、響應(yīng)速度快、開發(fā)周期短且準(zhǔn)確度高。選用的ＴｕｒｂｏＰＭＡＣＣｌｉｐｐｅｒ控制器功能齊全，結(jié)構(gòu)緊湊，性價(jià)比高。它采用ＴｕｒｂｏＰＭＡＣ２．ＣＰＵ處理器，并提供四軸伺服或步進(jìn)控制。ＰＭＡＣ提供的執(zhí)行軟件為Ｐｅｗｉｎ３２ｐｒｏ，支持ｗｉｎ９８，ｗｉｎ２０００，ｗｉｎＸＰ系統(tǒng)。它提供動(dòng)態(tài)鏈接庫Ｐｃｏｍｍ３２ｐｒｏ，支持ＶＣ、Ｃ＋＋開發(fā)或調(diào)用動(dòng)態(tài)鏈接庫的函數(shù)，完成運(yùn)動(dòng)控制器參數(shù)修改、執(zhí)行任務(wù)文件下載等功能。

采用Ｃｏｐｌｅｙ公司生產(chǎn)的ＡＣＪ．０５５．１８直流電機(jī)伺服驅(qū)動(dòng)器完成電機(jī)的速度控制和電流控制，該伺服驅(qū)動(dòng)器配備多種信號接口，如ＣＡＮ總線接口模塊，用于獲取電機(jī)編碼器的信號的反饋接口，以及用于接收多軸運(yùn)動(dòng)控制器傳輸?shù)目刂菩盘柕男盘柦涌�。機(jī)械臂的執(zhí)行單元為Ｍａｘｏｎ直流伺服電機(jī)。其實(shí)物測試圖如圖３．１６所示。５６

實(shí)現(xiàn)，系統(tǒng)軟件結(jié)構(gòu)及各個(gè)任務(wù)模塊如圖３．１７所示。速運(yùn)算功能實(shí)現(xiàn)軌跡插補(bǔ)、運(yùn)動(dòng)伺服控制等任務(wù)。每個(gè)任務(wù)采用各自對應(yīng)的線程改，，機(jī)械臂手動(dòng)操作等任務(wù)。下位機(jī)軟件利用ＰＭＡＣ自身語言開發(fā)，利用其高Ｃ＋＋６．０進(jìn)行開發(fā)，主要完成軌跡規(guī)劃、機(jī)械臂運(yùn)動(dòng)學(xué)計(jì)算、參數(shù)設(shè)置與修Ｖｉｓｕａｌ設(shè)計(jì)，分為上位機(jī)功能模塊和下位機(jī)運(yùn)動(dòng)計(jì)算模塊部分。上位機(jī)功能模塊采用ＸＰ作為操作系統(tǒng)�？刂栖浖捎媚K化機(jī)械臂控制軟件開發(fā)使用Ｗｉｎｄｏｗｓ３．４．２串聯(lián)機(jī)械臂系統(tǒng)軟件設(shè)計(jì)圖３．１６電機(jī)控制測試現(xiàn)場第三章機(jī)械臂運(yùn)動(dòng)軌跡規(guī)劃與控制系統(tǒng)研制５７偏置、扭角、質(zhì)心位置、慣量等參數(shù)。設(shè)定各關(guān)節(jié)的電機(jī)編碼器初始值、電機(jī)的參數(shù)初始化模塊：在程序里輸入六自由度機(jī)械臂連桿參數(shù)，包括連桿長度、圖３．１７機(jī)械臂控制系統(tǒng)軟件結(jié)構(gòu)圖

額定參數(shù)、參數(shù)限制等。編寫多軸運(yùn)動(dòng)控制器初始化程序。

逆運(yùn)動(dòng)學(xué)計(jì)算模塊：基于連桿Ｄ．Ｈ參數(shù)建立機(jī)械臂的正運(yùn)動(dòng)學(xué)方程和逆運(yùn)動(dòng)學(xué)方程，用Ｃ＋＋語言編寫運(yùn)動(dòng)學(xué)求解的數(shù)學(xué)運(yùn)算。將在笛卡爾空間描述的操作任務(wù)轉(zhuǎn)換至關(guān)節(jié)空間，采用向量記錄關(guān)節(jié)空間的關(guān)節(jié)位置序列。

軌跡規(guī)劃模塊：建立笛卡爾空間下末端執(zhí)行器的直線、圓弧位置軌跡。計(jì)算每段軌跡最優(yōu)的執(zhí)行時(shí)間，采用五次多項(xiàng)式插值函數(shù)完成關(guān)節(jié)空間的位置、速度和加速度的軌跡規(guī)劃。

通訊模塊：確定嵌入式ＰＣ與視覺系統(tǒng)及下層ＰＭＡＣ卡的數(shù)據(jù)通訊方式，并設(shè)定數(shù)據(jù)傳輸規(guī)則。完成通訊端口初始化，分配節(jié)點(diǎn)地址、定義數(shù)據(jù)傳輸類型、信息類型及信息格式。

機(jī)械臂在執(zhí)行任務(wù)時(shí)，采用通訊模塊時(shí)時(shí)偵聽視覺模塊傳遞的數(shù)據(jù)并進(jìn)行任務(wù)判斷，確認(rèn)任務(wù)后，通過軌跡規(guī)劃模塊、逆運(yùn)動(dòng)學(xué)計(jì)算模塊完成機(jī)械臂各關(guān)節(jié)的軌跡運(yùn)動(dòng)參數(shù)計(jì)算。將各參數(shù)傳輸至ＰＭＡＣ卡后，控制伺服驅(qū)動(dòng)器，實(shí)現(xiàn)機(jī)械臂各關(guān)節(jié)電機(jī)的伺服控制。機(jī)械臂控制系統(tǒng)軟件程序流程圖如圖３．１８所示。５８

圖３．１８機(jī)械臂控制系統(tǒng)軟件程序流程圖

３．４．３控制系統(tǒng)通信方式

機(jī)械臂控制系統(tǒng)設(shè)計(jì)中，采用ＰＣＩ０４總線實(shí)現(xiàn)機(jī)械臂控制系統(tǒng)的嵌入式ＰＣ與運(yùn)動(dòng)控制卡之間的高速通訊。由于機(jī)械臂控制系統(tǒng)需要獲取視覺系統(tǒng)提供的目標(biāo)物體位姿信息才能完成目標(biāo)操作，因此需要解決控制系統(tǒng)與視覺模塊之間的通信問題。

傳統(tǒng)的機(jī)器人系統(tǒng)中往往采用基于點(diǎn)對點(diǎn)連接的集中式通信方法。該方法結(jié)構(gòu)簡單，在傳感器和執(zhí)行器數(shù)量較少的控制系統(tǒng)中應(yīng)用較廣。但是由于本文設(shè)計(jì)的串聯(lián)機(jī)械臂的控制變量較多，而且對控制精度要求較高，傳統(tǒng)的集中式通信方法布線復(fù)雜，導(dǎo)致系統(tǒng)難以維護(hù)，可靠性和靈活性較低。因此，采用現(xiàn)場總線技５９

最新搜索

提高串聯(lián)機(jī)械臂運(yùn)動(dòng)精度的關(guān)鍵技術(shù)研究_圖文

等差數(shù)列基礎(chǔ)測試題(附詳細(xì)答案)

sql server2014安裝

談?wù)劕F(xiàn)代會(huì)議系統(tǒng)的組成_圖文

2016年生物燃料能源研究分析及發(fā)展趨勢預(yù)測

2013年司法考試試題及答案完美解析

奇門遁甲入門學(xué)習(xí)步驟

b35i郵政儲(chǔ)匯業(yè)務(wù)員初級試卷正文

教你分別手機(jī)行貨、水貨、港貨、歐貨

2016年海南省公務(wù)員面試每日一練(6.7)

  本文關(guān)鍵詞：提高串聯(lián)機(jī)械臂運(yùn)動(dòng)精度的關(guān)鍵技術(shù)研究，由筆耕文化傳播整理發(fā)布。