技術(shù)頻道

娓娓工業(yè)
您現(xiàn)在的位置: 中國(guó)傳動(dòng)網(wǎng) > 技術(shù)頻道 > 技術(shù)百科 > 基于LabVIEW的四自由度機(jī)械臂運(yùn)動(dòng)控制系統(tǒng)設(shè)計(jì)

基于LabVIEW的四自由度機(jī)械臂運(yùn)動(dòng)控制系統(tǒng)設(shè)計(jì)

時(shí)間:2008-10-27 09:39:00來(lái)源:zhangting

導(dǎo)語(yǔ):?短期內(nèi)實(shí)現(xiàn)4自由度機(jī)械臂(3臺(tái)交流伺服電機(jī)、1臺(tái)微型直流電機(jī))的 變參數(shù)同步運(yùn)動(dòng)控制,為鋼絲傳動(dòng)機(jī)構(gòu)的控制提供應(yīng)用解決方案。
應(yīng)用領(lǐng)域:控制設(shè)計(jì) 挑戰(zhàn): 短期內(nèi)實(shí)現(xiàn)4自由度機(jī)械臂(3臺(tái)交流伺服電機(jī)、1臺(tái)微型直流電機(jī))的 變參數(shù)同步運(yùn)動(dòng)控制,為鋼絲傳動(dòng)機(jī)構(gòu)的控制提供應(yīng)用解決方案。 應(yīng)用方案: 方案采用NI公司的LabVIEW8.2作為開(kāi)發(fā)平臺(tái),通過(guò)NI PCI-7344四軸運(yùn)動(dòng)控制卡和多功能數(shù)據(jù)采集卡來(lái)實(shí)現(xiàn)對(duì)于機(jī)械臂四個(gè)自由度的驅(qū)動(dòng)控制,同時(shí)利用LabVIEW8.2中新增Project文件管理功能和控制設(shè)計(jì)工具包實(shí)現(xiàn)控制軟件的快速開(kāi)發(fā)與發(fā)布。 使用產(chǎn)品: LabVIEW 8.20 NI PCI-7344四軸運(yùn)動(dòng)控制卡 介紹: 盡管對(duì)于機(jī)械操作臂的研究已不是一個(gè)全新的課題,但是,如何在保證機(jī)械手臂高的位置精度的條件盡可能地降低制造成本和縮短制造周期,這仍然是值得我們不斷探索的問(wèn)題。 傳統(tǒng)工業(yè)機(jī)械臂,其設(shè)計(jì)方法多為串聯(lián)形式,即通過(guò)將驅(qū)動(dòng)與傳動(dòng)元件如電機(jī)、減速器等直接安裝在轉(zhuǎn)動(dòng)副附近,這樣的設(shè)計(jì)雖然簡(jiǎn)單直接但是由于驅(qū)動(dòng)件自身成為了機(jī)械臂負(fù)載,所以大大減少了機(jī)械臂的有效載荷,同時(shí)也會(huì)產(chǎn)生振動(dòng)等不良影響降低機(jī)械臂定位精度。在本課題中我們提出了利用鋼絲傳動(dòng)機(jī)構(gòu)來(lái)實(shí)現(xiàn)驅(qū)動(dòng)件到末端負(fù)載的動(dòng)力傳遞,這樣的設(shè)計(jì)可以最大程度的減小了驅(qū)動(dòng)件本身對(duì)于機(jī)械臂負(fù)載能力的影響,同時(shí)由于鋼絲本身的彈性也使得機(jī)械臂具有一定柔性,實(shí)現(xiàn)一定的自適應(yīng)功能。由于傳動(dòng)件的位置調(diào)整,所以在控制系 統(tǒng)的設(shè)計(jì)要求能夠?qū)τ跈C(jī)械臂最終的末端 位置能夠準(zhǔn)確地進(jìn)行反饋控制。 本系統(tǒng)以PCI-7344為基礎(chǔ),通過(guò)NI公司最新的LabVIEW8.2為開(kāi)發(fā)平臺(tái)對(duì)3臺(tái)伺服電機(jī)實(shí)行位置伺服和編碼器反饋,對(duì)直流電機(jī)利用線性電位器反饋電壓的方式實(shí)現(xiàn)了角度的反饋控制。借助LabVIEW8.2的強(qiáng)大功能,我們得以在短時(shí)間內(nèi)完成了控制系統(tǒng)的開(kāi)發(fā),同時(shí)保證了機(jī)械臂的運(yùn)動(dòng)精度與負(fù)載能力。 四自由度機(jī)械臂機(jī)械系統(tǒng) 本文討論的四自由度機(jī)械臂面向中小型物流系統(tǒng)應(yīng)用。其基本的設(shè)計(jì)要求為:實(shí)用、有相對(duì)大的作業(yè)空間、抓取重量不小于2.5kg、具有不大于10mm的重復(fù)定位精度、自重輕、外觀整潔。 [align=center] 圖1 機(jī)械臂整體結(jié)構(gòu)示意圖[/align] 出于操作便捷實(shí)用的考慮,設(shè)計(jì)腰部回轉(zhuǎn)、大臂俯仰、小臂俯仰、腕部回轉(zhuǎn)4個(gè)自由度,整體采用重力方向折疊展開(kāi)型結(jié)構(gòu),大臂俯仰與小臂俯仰為一組平面自由度。機(jī)械手臂主要通過(guò)鋼絲繩傳動(dòng)機(jī)構(gòu),把小臂俯仰關(guān)節(jié)的電機(jī)和齒輪減速器等額外負(fù)載放置在機(jī)械臂基座部分,從而減輕了對(duì)其他關(guān)節(jié)驅(qū)動(dòng)元件的要求及機(jī)械臂整體的功耗,降低了機(jī)械臂自身重量,增加了其對(duì)外做功的能力和效率。 [align=center] 圖2 鋼絲傳動(dòng)機(jī)構(gòu)原理圖[/align] 該機(jī)械臂不僅實(shí)現(xiàn)重量輕、對(duì)外做功能力大等性能指標(biāo)要求,而且具有制造簡(jiǎn)單造價(jià)低等優(yōu)點(diǎn)有利于工業(yè)推廣普及。通過(guò)新型內(nèi)嵌式鋼絲繩張緊裝置可以輕松簡(jiǎn)便的對(duì)張緊力進(jìn)行現(xiàn)場(chǎng)調(diào)節(jié),解決了鋼絲繩傳動(dòng)存在的各種問(wèn)題,有效的提高了機(jī)械臂的重復(fù)定位精度,自重與負(fù)載能力比達(dá)到4:1,可以廣泛的應(yīng)用到以中小型物流系統(tǒng)為代表的工業(yè)環(huán)境中,也可作為教學(xué)科研演示設(shè)備進(jìn)行推廣。
[align=center] 圖3 四自由度機(jī)械臂樣機(jī)[/align] [align=center] 圖4 鋼絲傳動(dòng)機(jī)構(gòu)示意圖[/align] 控制系統(tǒng)設(shè)計(jì) 在綜合考慮了項(xiàng)目的機(jī)械結(jié)構(gòu)要求、功能目標(biāo)、開(kāi)發(fā)周期等因素后,我們對(duì)于控制系統(tǒng)的設(shè)計(jì)定下如下的方案: 1. 對(duì)于底盤(pán)(腰部)、大臂俯仰、小臂俯仰這三個(gè)自由度,利用伺服電機(jī)驅(qū)動(dòng)和編碼器反饋來(lái)構(gòu)成閉環(huán)控制系統(tǒng),由于本項(xiàng)目對(duì)于定位精度的要求,伺服電機(jī)控制方式選為位置控制(即脈沖控制)。因此我們選用了NI PCI-7344作為伺服電機(jī)的運(yùn)動(dòng)控制器。 2. 對(duì)于手腕旋轉(zhuǎn)自由度以及抓取手爪吸合張開(kāi)的控制,考慮到這部分機(jī)構(gòu)主要處于靠近末端負(fù)載,要求體積尺寸小等原因,我們選擇采用了直流電機(jī)配齒輪減速器并通過(guò)線性電位計(jì)的電壓值來(lái)間接測(cè)量角度值的方案。 3. LabVIEW本身帶有大量的數(shù)字信號(hào)處理vi,可以十分有效地解決控制系統(tǒng)中常會(huì)遇到的信號(hào)干擾及濾波等問(wèn)題。利用LabVIEW更可以大幅縮短項(xiàng)目的開(kāi)發(fā)周期,在短短3個(gè)月內(nèi)我們迅速完成了從機(jī)械設(shè)計(jì)、材料加工、控制系統(tǒng)軟硬件設(shè)計(jì)等進(jìn)度,這些也是我們優(yōu)先選擇LabVIEW作為系統(tǒng)開(kāi)發(fā)平臺(tái)的重要原因。 圖5顯示了控制系統(tǒng)構(gòu)成的整體框圖。 機(jī)械臂的技術(shù)要求后,主要功能大致可以分為以下幾類:系統(tǒng)硬件信息反饋、 運(yùn)動(dòng)參數(shù)設(shè)置、手動(dòng)及自動(dòng)運(yùn)動(dòng)控制、機(jī)械臂空間位置的捕捉與再現(xiàn)、文件操作等。這幾者之間的相互關(guān)系可以通過(guò)如下的軟件流程圖來(lái)表示。
軟件設(shè)計(jì) 控制系統(tǒng)軟件設(shè)計(jì)在考慮了整個(gè)需要說(shuō)明的是對(duì)于伺服電機(jī)位置的檢測(cè)主要是通過(guò)對(duì)相應(yīng)伺服電機(jī)編碼器的讀取來(lái)獲得實(shí)際位置的反饋,在極限位置處我們借助霍爾傳感器向PCI-7344傳遞觸發(fā)信號(hào),實(shí)現(xiàn)極限位置的檢測(cè)并通過(guò)定時(shí)讀取IO寄存器的值來(lái)實(shí)現(xiàn)機(jī)械臂運(yùn)動(dòng)狀態(tài)的反饋。而直流電機(jī)的位置檢測(cè)則是通過(guò)固結(jié)在齒輪減速器上的線性電位機(jī)的電壓來(lái)間接測(cè)量出直流電機(jī)的轉(zhuǎn)角。
軟件的主界面如下圖所示:
開(kāi)發(fā)過(guò)程 在LabVIEW8.0之前的版本中,許多在主程序中需要多次復(fù)用的功能都是通過(guò)subvi封裝來(lái)進(jìn)行調(diào)用的。當(dāng)這樣的subvi數(shù)量多的時(shí)候,對(duì)于這些文件的管理會(huì)成為不小的工作量。甚至,因?yàn)槟承﹕ubvi的管理不善(如文件丟失等情況),整個(gè)軟件系統(tǒng)的工作會(huì)受到較大影響。在LabVIEW推出的8.0及8.2版中,Project開(kāi)發(fā)方式的推出給這一問(wèn)題的解決帶來(lái)了希望。 通過(guò)Project Explorer我們?cè)陂_(kāi)發(fā)過(guò)程不僅可以有效對(duì)于各個(gè)功能(如伺服驅(qū)動(dòng)器工作狀態(tài)反饋、直流電機(jī)位置測(cè)量、直流電機(jī)位置控制等)進(jìn)行獨(dú)立開(kāi)發(fā),更可以保證主vi中調(diào)用的功能與subvi的一致,而不用像低版本中那樣,一旦subvi有變化,主vi需要逐個(gè)去手動(dòng)更新。 使用Project Explorer的另一個(gè)好處在于程序封裝發(fā)布的便利。如圖8所示,通過(guò)build specification中的不同選擇,可以將源程序封裝成exe文件,或者是帶LabVIEW Runtime Engine的Installer安裝文件,以及動(dòng)態(tài)鏈接庫(kù)(dll)和屏蔽了源代碼的vi(Block Diagram不可見(jiàn))。
此外,在利用板卡采集直流電機(jī)電位器輸入電壓時(shí)我們遇到了交流干擾信號(hào)的影響,借助LabVIEW自帶的信號(hào)處理函數(shù)可以有效地抑制干擾信號(hào)對(duì)于程序判斷邏輯的影響(在現(xiàn)場(chǎng)無(wú)法快速需得物理濾波器時(shí),可以考慮利用LabVIEW的軟件濾波)。 文件操作 在程序的開(kāi)發(fā)過(guò)程中我們時(shí)常會(huì)遇到需要對(duì)一些數(shù)據(jù)進(jìn)行添加、保存、刪除、讀取等功能的場(chǎng)合,在例如VC或者VB等開(kāi)發(fā)平臺(tái)中,文檔的操作由于涉及了文檔模版結(jié)構(gòu)的設(shè)計(jì)、文件指針操作及消息影射等,文件操作的實(shí)現(xiàn)顯得較為復(fù)雜。 而在LabVIEW中借助write tospreadsheet、read from spreadsheet等文件操作vi和表格控件、數(shù)組操作vi及自定義空間等就可以輕松實(shí)現(xiàn)常用的txt、xls等數(shù)據(jù)文件格式的讀寫(xiě)等功能 (如圖9所示)。
結(jié)論 借助LabVIEW,我們?cè)谡n題中能夠快速地將開(kāi)發(fā)和調(diào)試過(guò)程有機(jī)地結(jié)合在一起,利用LabVIEW開(kāi)發(fā)出能夠有效將機(jī)械臂所需要的電機(jī)驅(qū)動(dòng)器、位置編碼器、極限位置傳感器和數(shù)字IO口等硬件資源整合的控制系統(tǒng)設(shè)計(jì)和相應(yīng)軟件,并且保證了機(jī)構(gòu)的精度和開(kāi)發(fā)時(shí)間的進(jìn)度要求。 參考文獻(xiàn) [1] 雷振山.LabVIEW 7 EXPRESS實(shí)用技術(shù)教程.中國(guó)鐵道出版社.2004 [2] 楊樂(lè)平.LabVIEW高級(jí)程序設(shè)計(jì).清華大學(xué)出版社.2003 [3] Jianjun Yuan, Weijun Zhang, "Research on Novel Wire Driving Robot Manipulator for Local Industrial Production Line", Proc. of the IEEE Int. Conf. on Mechatronics and Automation, 2007 [4] 宮金良,趙現(xiàn)朝,高峰.基于LabVIEW和PXI-7538多軸運(yùn)動(dòng)控制卡的地震模擬振動(dòng)臺(tái)控制系統(tǒng)設(shè)計(jì).美國(guó)國(guó)家儀器中國(guó)有限公司2006年優(yōu)秀論文合訂本

標(biāo)簽:

點(diǎn)贊

分享到:

上一篇:高壓變頻器的IGBT模塊選擇及...

下一篇:微能WIN-V63矢量控制變頻器在...

中國(guó)傳動(dòng)網(wǎng)版權(quán)與免責(zé)聲明:凡本網(wǎng)注明[來(lái)源:中國(guó)傳動(dòng)網(wǎng)]的所有文字、圖片、音視和視頻文件,版權(quán)均為中國(guó)傳動(dòng)網(wǎng)(www.surachana.com)獨(dú)家所有。如需轉(zhuǎn)載請(qǐng)與0755-82949061聯(lián)系。任何媒體、網(wǎng)站或個(gè)人轉(zhuǎn)載使用時(shí)須注明來(lái)源“中國(guó)傳動(dòng)網(wǎng)”,違反者本網(wǎng)將追究其法律責(zé)任。

本網(wǎng)轉(zhuǎn)載并注明其他來(lái)源的稿件,均來(lái)自互聯(lián)網(wǎng)或業(yè)內(nèi)投稿人士,版權(quán)屬于原版權(quán)人。轉(zhuǎn)載請(qǐng)保留稿件來(lái)源及作者,禁止擅自篡改,違者自負(fù)版權(quán)法律責(zé)任。

網(wǎng)站簡(jiǎn)介|會(huì)員服務(wù)|聯(lián)系方式|幫助信息|版權(quán)信息|網(wǎng)站地圖|友情鏈接|法律支持|意見(jiàn)反饋|sitemap

傳動(dòng)網(wǎng)-工業(yè)自動(dòng)化與智能制造的全媒體“互聯(lián)網(wǎng)+”創(chuàng)新服務(wù)平臺(tái)

網(wǎng)站客服服務(wù)咨詢采購(gòu)咨詢媒體合作

Chuandong.com Copyright ?2005 - 2025 ,All Rights Reserved 深圳市奧美大唐廣告有限公司 版權(quán)所有
粵ICP備 14004826號(hào) | 營(yíng)業(yè)執(zhí)照證書(shū) | 不良信息舉報(bào)中心 | 粵公網(wǎng)安備 44030402000946號(hào)