專利名稱：一種虛擬工程機(jī)器人系統(tǒng)及控制方法
技術(shù)領(lǐng)域：
本發(fā)明是 一種用于機(jī)器人領(lǐng)域的一種虛擬工程機(jī)器人系統(tǒng)及控制方法，特別是一種解決遙操作工程機(jī)器人系統(tǒng)時延問題的虛擬工程機(jī)器人系統(tǒng)及控制方法，屬于虛擬工程機(jī)器人系統(tǒng)及控制方法的改造技術(shù)。
背景技術(shù)：
遙操作工程機(jī)器人系統(tǒng)是指在人操作下完成復(fù)雜工程作業(yè)任務(wù)的一種遠(yuǎn)距離操作系統(tǒng)，它能夠幫助人類在危險和極端環(huán)境下工作。在理想情況下，工程機(jī)器人可以實時地反應(yīng)操作者的命令。但是，由于操作者與工程機(jī)器人的工作現(xiàn)場距離較遠(yuǎn)、工作環(huán)境復(fù)雜以及通訊帶寬的限制，系統(tǒng)不可避免地存在時延問題，造成操作者的命令不能實時地反應(yīng)在工程機(jī)器人上。由于時間的滯后，工程機(jī)器人與環(huán)境的交互信息(包括圖像、力、位移等)不能實時地反饋給操作者，從而發(fā)生誤操作。這種大時延的存在，嚴(yán)重影響了系統(tǒng)的穩(wěn)定性、可操作性。針對遙操作系統(tǒng)的時延問題，早先的研究者采用“移動-等待”策略，即操作者先移動一下操縱桿，等操作者感覺到工程機(jī)器人與環(huán)境的力反饋后，再移動一下操縱桿。但這種方法操作性差，力反饋效果較模糊。后來有學(xué)者從控制的角度出發(fā)，提出了許多新的方案，基本思想是通過采用合理的控制算法處理遙操作系統(tǒng)主端和從端的力以及位移信息。目前，比較常用的控制算法有基于散射理論方法、基于事件方法、基于預(yù)測控制方法、基于H- c 理論控制法、自適應(yīng)控制法、共享柔順控制法、LOG最優(yōu)控制器等。但是以上算法只適用于小時延系統(tǒng)，在大時延下的效果還是不明顯。目前，還未找到更有效的方法解決時延問題。

發(fā)明內(nèi)容
本發(fā)明的目的在于考慮上述問題而提供一種能有效解決時延問題的虛擬工程機(jī)器人系統(tǒng)。本發(fā)明設(shè)計合理，方便實用。本發(fā)明的另一目的在于提供一種控制簡單方便的虛擬工程機(jī)器人系統(tǒng)的控制方法。本發(fā)明的技術(shù)方案是本發(fā)明的虛擬工程機(jī)器人系統(tǒng)，包括有力反饋操縱桿、虛擬工程機(jī)器人控制器、投影裝置、屏幕，其中用于將操作者的操縱運動轉(zhuǎn)換為虛擬工程機(jī)器人及工程機(jī)器人的位移設(shè)定信號的力反饋操縱桿與虛擬工程機(jī)器人控制器連接，且力反饋操縱桿將力反饋信號轉(zhuǎn)換為作用力作用給操作者，虛擬工程機(jī)器人控制器的信號輸出端與投影裝置連接，投影裝置將虛擬工程機(jī)器人控制器生成的虛擬工程機(jī)器人及作業(yè)對象投影到屏幕。上述虛擬工程機(jī)器人控制器包括用于描述虛擬工程機(jī)器人幾何特征的幾何模塊、用于確定虛擬工程機(jī)器人各關(guān)節(jié)連桿之間位姿關(guān)系的運動學(xué)模塊、用于實現(xiàn)虛擬工程機(jī)器人手爪與作業(yè)對象之間的碰撞檢測的碰撞檢測算法模塊、用于計算虛擬工程機(jī)器人手爪與作業(yè)對象相互碰撞的作用力的力反饋算法模塊、用于將力反饋操作桿的位移設(shè)定信號從虛擬工程機(jī)器人控制器傳輸給工程機(jī)器人控制器的通信模塊。上述用于描述虛擬工程機(jī)器人幾何特征的幾何模塊采用Opengl和SolidWorks建模法構(gòu)建。上述用于確定虛擬工程機(jī)器人各關(guān)節(jié)連桿之間位姿關(guān)系的運動學(xué)模塊采用Denavit-Hartenberg 表不法建立。上述用于實現(xiàn)虛擬工程機(jī)器人手爪與作業(yè)對象之間的碰撞檢測的碰撞檢測算法模塊基于軸向包圍盒法構(gòu)建。上述用于虛擬工程機(jī)器人控制器與工程機(jī)器人控制器的網(wǎng)絡(luò)通訊的通信模塊基 于Winsock設(shè)計。本發(fā)明虛擬工程機(jī)器人系統(tǒng)的控制方法，包括如下步驟
1)操作者面對屏幕(4)，觀察屏幕(4)上的虛擬工程機(jī)器人和作業(yè)對象；
2)操作者操縱力反饋操縱桿(1)，將位移設(shè)定信號傳給虛擬工程機(jī)器人控制器(2)及工程機(jī)器人控制器，控制虛擬工程機(jī)器人及工程機(jī)器人運動并抓取作業(yè)對象；
3)當(dāng)虛擬工程機(jī)器人手爪抓取作業(yè)對象時，碰撞檢測算法模塊(7)檢測出手爪與作業(yè)對象的碰撞行為，同時力反饋算法模塊(8)計算出手爪與作業(yè)對象相互碰撞的作用力，并通過力反饋操縱桿(I)反饋給操作者；由于操作者可直接通過觀察屏幕(4)上的虛擬工程機(jī)器人與作業(yè)對象的位姿關(guān)系來操作虛擬工程機(jī)器人及工程機(jī)器人完成作業(yè)任務(wù)，不用等待遠(yuǎn)處工程機(jī)器人作業(yè)現(xiàn)場反饋回來的信息，故能解決遙操作工程機(jī)器人系統(tǒng)存在的時延問題。本發(fā)明的虛擬工程機(jī)器人系統(tǒng)及控制方法具有以下特點
I)基于Opengl和SolidWorks建立幾何模塊和基于Denavit-Hartenberg表不法建立運動學(xué)模塊，實現(xiàn)了虛擬工程機(jī)器人的幾何與運動學(xué)建模，不僅滿足虛擬工程機(jī)器人建模逼真的要求，且降低了建模難度，縮短了開發(fā)周期。2)基于軸向包圍盒法構(gòu)建碰撞檢測算法模塊，實現(xiàn)了虛擬機(jī)械手爪與待抓物體之間的精確碰撞檢測，保證了虛擬工程機(jī)器人系統(tǒng)的實時性。3)利用力反饋算法模塊計算虛擬工程機(jī)器人手爪與作業(yè)對象相互碰撞的作用力，實現(xiàn)了對操作者的力反饋。4)基于Winsock設(shè)計通信模塊，實現(xiàn)了虛擬工程機(jī)器人控制器與工程機(jī)器人控制器之間的數(shù)據(jù)傳輸，保證了數(shù)據(jù)傳輸?shù)目煽啃院驼_性。本發(fā)明是一種設(shè)計巧妙，性能優(yōu)良，方便實用的虛擬工程機(jī)器人系統(tǒng)及控制方法。


圖I為本發(fā)明的原理 圖2為本發(fā)明虛擬工程機(jī)器人控制器的原理圖。
具體實施例方式實施例
本發(fā)明的結(jié)構(gòu)示意圖如圖I所示，本發(fā)明的虛擬工程機(jī)器人系統(tǒng)，包括有力反饋操縱桿I、虛擬工程機(jī)器人控制器2、投影裝置3、屏幕4，其中用于將操作者的操縱運動轉(zhuǎn)換為虛擬工程機(jī)器人及工程機(jī)器人的位移設(shè)定信號的力反饋操縱桿I與虛擬工程機(jī)器人控制器2連接，且力反饋操縱桿I將力反饋信號轉(zhuǎn)換為作用力作用給操作者，虛擬工程機(jī)器人控制器2的信號輸出端與投影裝置3連接，投影裝置3將虛擬工程機(jī)器人控制器2生成的虛擬工程機(jī)器人及作業(yè)對象投影到屏幕4。本實施例中，上述虛擬工程機(jī)器人控制器2包括幾何模塊5、運動學(xué)模塊6、碰撞檢測算法模塊7、力反饋算法模塊8、通信模塊9。幾何模塊5用于描述虛擬工程機(jī)器人幾何特征。運動學(xué)模塊6用于確定虛擬工程機(jī)器人各關(guān) 節(jié)連桿之間位姿關(guān)系。碰撞檢測算法模塊7用于實現(xiàn)虛擬工程機(jī)器人手爪與作業(yè)對象之間的碰撞檢測。力反饋算法模塊8用于計算虛擬工程機(jī)器人手爪與作業(yè)對象相互碰撞的作用力。通信模塊9用于將力反饋操作桿的位移設(shè)定信號從虛擬工程機(jī)器人控制器傳輸給工程機(jī)器人控制器。本實施例中，上述用于描述虛擬工程機(jī)器人幾何特征的幾何模塊5采用Opengl和Solidfforks建模法構(gòu)建。本實施例中，上述用于確定虛擬工程機(jī)器人各關(guān)節(jié)連桿之間位姿關(guān)系的運動學(xué)模塊6采用Denavit-Hartenberg表示法建立。上述用于實現(xiàn)虛擬工程機(jī)器人手爪與作業(yè)對象之間的碰撞檢測的碰撞檢測算法模塊7基于軸向包圍盒法構(gòu)建構(gòu)建。上述用于虛擬工程機(jī)器人控制器與工程機(jī)器人控制器的網(wǎng)絡(luò)通訊的通信模塊9基于Winsock設(shè)計。本發(fā)明虛擬工程機(jī)器人系統(tǒng)的控制方法，包括如下步驟
1)操作者面對屏幕4，觀察屏幕4上的虛擬工程機(jī)器人和作業(yè)對象；
2)操作者操縱力反饋操縱桿I，將位移設(shè)定信號傳給虛擬工程機(jī)器人控制器2及工程機(jī)器人控制器，控制虛擬工程機(jī)器人及工程機(jī)器人運動并抓取作業(yè)對象；
3)當(dāng)虛擬工程機(jī)器人手爪抓取作業(yè)對象時，碰撞檢測算法模塊7檢測出手爪與作業(yè)對象的碰撞行為，同時力反饋算法模塊8計算出手爪與作業(yè)對象相互碰撞的作用力，并通過力反饋操縱桿I反饋給操作者；由于操作者可直接通過觀察屏幕4上的虛擬工程機(jī)器人與作業(yè)對象的位姿關(guān)系來操作虛擬工程機(jī)器人及工程機(jī)器人完成作業(yè)任務(wù)，不用等待遠(yuǎn)處工程機(jī)器人作業(yè)現(xiàn)場反饋回來的信息，故能解決遙操作工程機(jī)器人系統(tǒng)存在的時延問題。
權(quán)利要求
1.一種虛擬工程機(jī)器人系統(tǒng)，其特征在于包括有力反饋操縱桿(I)、虛擬工程機(jī)器人控制器(2)、投影裝置(3)、屏幕(4)，其中用于將操作者的操縱運動轉(zhuǎn)換為虛擬工程機(jī)器人及工程機(jī)器人的位移設(shè)定信號的力反饋操縱桿(I)與虛擬工程機(jī)器人控制器(2)連接，且力反饋操縱桿(I)將力反饋信號轉(zhuǎn)換為作用力作用給操作者，虛擬工程機(jī)器人控制器(2)的信號輸出端與投影裝置(3 )連接，投影裝置(3 )將虛擬工程機(jī)器人控制器(2 )生成的虛擬工程機(jī)器人及作業(yè)對象投影到屏幕(4 )。
2.根據(jù)權(quán)利要求I所述的虛擬工程機(jī)器人系統(tǒng)，其特征在于上述虛擬工程機(jī)器人控制器(2)包括用于描述虛擬工程機(jī)器人幾何特征的幾何模塊(5)、用于確定虛擬工程機(jī)器人各關(guān)節(jié)連桿之間位姿關(guān)系的運動學(xué)模塊(6)、用于實現(xiàn)虛擬工程機(jī)器人手爪與作業(yè)對象之間的碰撞檢測的碰撞檢測算法模塊(7)、用于計算虛擬工程機(jī)器人手爪與作業(yè)對象相互碰撞的作用力的力反饋算法模塊(8)、用于將力反饋操作桿的位移設(shè)定信號從虛擬工程機(jī)器人控制器傳輸給工程機(jī)器人控制器的通信模塊(9 )。
3.根據(jù)權(quán)利要求2所述的虛擬工程機(jī)器人系統(tǒng)，其特征在于上述用于描述虛擬工程機(jī)器人幾何特征的幾何模塊(5)采用Opengl和SolidWorks建模法構(gòu)建。
4.根據(jù)權(quán)利要求2所述的虛擬工程機(jī)器人系統(tǒng)，其特征在于上述用于確定虛擬工程機(jī)器人各關(guān)節(jié)連桿之間位姿關(guān)系的運動學(xué)模塊(6)采用Denavit-Hartenberg表示法建立。
5.根據(jù)權(quán)利要求2所述的虛擬工程機(jī)器人系統(tǒng)，其特征在于上述用于實現(xiàn)虛擬工程機(jī)器人手爪與作業(yè)對象之間的碰撞檢測的碰撞檢測算法模塊(7)基于軸向包圍盒法構(gòu)建。
6.根據(jù)權(quán)利要求2所述的虛擬工程機(jī)器人系統(tǒng)，其特征在于上述用于虛擬工程機(jī)器人控制器與工程機(jī)器人控制器的網(wǎng)絡(luò)通訊的通信模塊(9)基于Winsock設(shè)計。
7.根據(jù)權(quán)利要求I所述的虛擬工程機(jī)器人系統(tǒng)的控制方法，其特征在于包括如下步驟 1)操作者面對屏幕(4)，觀察屏幕(4)上的虛擬工程機(jī)器人和作業(yè)對象； 2)操作者操縱力反饋操縱桿(1)，將位移設(shè)定信號傳給虛擬工程機(jī)器人控制器(2)及工程機(jī)器人控制器，控制虛擬工程機(jī)器人及工程機(jī)器人運動并抓取作業(yè)對象； 3)當(dāng)虛擬工程機(jī)器人手爪抓取作業(yè)對象時，碰撞檢測算法模塊(7)檢測出手爪與作業(yè)對象的碰撞行為，同時力反饋算法模塊(8)計算出手爪與作業(yè)對象相互碰撞的作用力，并通過力反饋操縱桿(I)反饋給操作者；由于操作者可直接通過觀察屏幕(4)上的虛擬工程機(jī)器人與作業(yè)對象的位姿關(guān)系來操作虛擬工程機(jī)器人及工程機(jī)器人完成作業(yè)任務(wù)，不用等待遠(yuǎn)處工程機(jī)器人作業(yè)現(xiàn)場反饋回來的信息，故能解決遙操作工程機(jī)器人系統(tǒng)存在的時延問題。
全文摘要
本發(fā)明是一種虛擬工程機(jī)器人系統(tǒng)及控制方法。包括有力反饋操縱桿(1)、虛擬工程機(jī)器人控制器(2)、投影裝置(3)、屏幕(4)，其中用于將操作者的操縱運動轉(zhuǎn)換為虛擬工程機(jī)器人及工程機(jī)器人的位移設(shè)定信號的力反饋操縱桿(1)與虛擬工程機(jī)器人控制器(2)連接，且力反饋操縱桿(1)將力反饋信號轉(zhuǎn)換為作用力作用給操作者，虛擬工程機(jī)器人控制器(2)的信號輸出端與投影裝置(3)連接，投影裝置(3)將虛擬工程機(jī)器人控制器(2)生成的虛擬工程機(jī)器人及作業(yè)對象投影到屏幕(4)。本發(fā)明能有效解決遙操作工程機(jī)器人系統(tǒng)時延問題，控制簡單，方便實用。
文檔編號B25J13/08GK102814815SQ20121030463
公開日2012年12月12日 申請日期2012年8月24日 優(yōu)先權(quán)日2012年8月24日
發(fā)明者李笑, 黃志鋒 申請人:廣東工業(yè)大學(xué)