亚洲成年人黄色一级片,日本香港三级亚洲三级,黄色成人小视频,国产青草视频,国产一区二区久久精品,91在线免费公开视频,成年轻人网站色直接看

機(jī)械手控制系統(tǒng)的制作方法

文檔序號(hào):11681181閱讀:331來源:國知局
機(jī)械手控制系統(tǒng)的制造方法與工藝

本發(fā)明涉及機(jī)械電子領(lǐng)域,尤其涉及一種機(jī)械手控制系統(tǒng)。



背景技術(shù):

當(dāng)今社會(huì)由于各種事故、自然災(zāi)害以及疾病等原因,出現(xiàn)需要?dú)埣踩耸?,其中,許多殘疾人士是失去單臂或者雙臂的情況,手臂在日常生活中具有重要的作用,如果沒有手臂,幾乎是日常生活無法自理?,F(xiàn)有技術(shù)中,雖然出現(xiàn)了許多假肢手臂,但是這些假肢手臂僅僅能夠起到簡單的作用,或者說主要是起到美觀的作用,而無法真正在生活中應(yīng)用。



技術(shù)實(shí)現(xiàn)要素:

本發(fā)明提供一種機(jī)械手控制系統(tǒng),以實(shí)現(xiàn)通過人體的肌肉動(dòng)作來控制機(jī)械手動(dòng)作。

為了實(shí)現(xiàn)上述目的,本發(fā)明提供了一種機(jī)械手控制系統(tǒng),包括:至少一個(gè)傳感器、中央處理模塊、多個(gè)用于驅(qū)動(dòng)手指運(yùn)動(dòng)的電機(jī)、每個(gè)電機(jī)分別對(duì)應(yīng)一個(gè)電機(jī)驅(qū)動(dòng)單元、手指模式切換開關(guān)、用于給所述控制系統(tǒng)供電的電源,其中,所述傳感器的感應(yīng)端抵接在人體肢體上,所述傳感器與所述中央處理模塊的第一輸入端電連接,所述中央處理模塊的輸出端與所述電機(jī)驅(qū)動(dòng)單元的輸入端電連接,所述電機(jī)驅(qū)動(dòng)單元的輸出端與所述電機(jī)的輸入端電連接;所述傳感器,用于檢測人體肢體部位在進(jìn)行手指運(yùn)動(dòng)時(shí)所產(chǎn)生的肌電信號(hào);所述手指模式控制開關(guān)與所述中央處理模塊的第三輸入端電連接,用于向所述中央處理模塊輸入用于切換預(yù)設(shè)的手指模式的模式切換信號(hào);所述中央處理模塊,用于根據(jù)所述傳感器檢測到的肌電信號(hào)和所述模式切換信號(hào),向所述電機(jī)驅(qū)動(dòng)單元發(fā)出電機(jī)控制信號(hào);所述電機(jī)驅(qū)動(dòng)單元,用于根據(jù)所述電機(jī)控制信號(hào)驅(qū)動(dòng)所述電機(jī)運(yùn)轉(zhuǎn);所述手指模式切換開關(guān)的物理按鍵設(shè)置在所述機(jī)械手的外表面。

本發(fā)明提供的機(jī)械手控制系統(tǒng),通過傳感器檢測人體控制手指動(dòng)作時(shí)所傳送的肌電信號(hào),由中央處理模塊根據(jù)傳感器檢測到的肌電信號(hào)向電機(jī)驅(qū)動(dòng)單元發(fā)出電機(jī)控制信號(hào),進(jìn)而由電機(jī)驅(qū)動(dòng)單元根據(jù)電機(jī)控制信號(hào)驅(qū)動(dòng)電機(jī)運(yùn)轉(zhuǎn)。本發(fā)明實(shí)施例能夠根據(jù)人體控制手指動(dòng)作時(shí)所傳送的肌電信號(hào)控制機(jī)械手動(dòng)作,實(shí)現(xiàn)機(jī)械手動(dòng)作的自動(dòng)化控制,便于對(duì)機(jī)械手進(jìn)行使用操作。

上述說明僅是本發(fā)明技術(shù)方案的概述,為了能夠更清楚了解本發(fā)明的技術(shù)手段,而可依照說明書的內(nèi)容予以實(shí)施,并且為了讓本發(fā)明的上述和其它目的、特征和優(yōu)點(diǎn)能夠更明顯易懂,以下特舉本發(fā)明的具體實(shí)施方式。

附圖說明

圖1為本發(fā)明實(shí)施例一所提供的機(jī)械手控制系統(tǒng)的結(jié)構(gòu)示意圖。

圖2為本發(fā)明實(shí)施例二所提供的機(jī)械手控制系統(tǒng)的結(jié)構(gòu)示意圖之一。

圖3為本發(fā)明實(shí)施例二所提供的機(jī)械手控制系統(tǒng)的結(jié)構(gòu)示意圖之二。

圖4為本發(fā)明實(shí)施例三所提供的機(jī)械手控制系統(tǒng)的使用狀態(tài)示意圖。

圖5為本發(fā)明實(shí)施例四所提供的機(jī)械手控制系統(tǒng)的結(jié)構(gòu)示意圖。

圖6為本發(fā)明實(shí)施例四所提供的機(jī)械手控制系統(tǒng)的使用狀態(tài)示意圖。

具體實(shí)施方式

下面將參照附圖更詳細(xì)地描述本公開的示例性實(shí)施例。雖然附圖中顯示了本公開的示例性實(shí)施例,然而應(yīng)當(dāng)理解,可以以各種形式實(shí)現(xiàn)本公開而不應(yīng)被這里闡述的實(shí)施例所限制。相反,提供這些實(shí)施例是為了能夠更透徹地理解本公開,并且能夠?qū)⒈竟_的范圍完整的傳達(dá)給本領(lǐng)域的技術(shù)人員。

下面結(jié)合附圖對(duì)本發(fā)明實(shí)施例的機(jī)械手控制系統(tǒng)進(jìn)行詳細(xì)描述。

實(shí)施例一

如圖1所示,圖1為本發(fā)明實(shí)施例一所提供的機(jī)械手控制系統(tǒng)的結(jié)構(gòu)示意圖。本發(fā)明實(shí)施例的機(jī)械手控制系統(tǒng)包括:至少一個(gè)傳感器、中央處理模塊、用于驅(qū)動(dòng)手指運(yùn)動(dòng)的電機(jī)、電機(jī)驅(qū)動(dòng)單元以及用于給控制系統(tǒng)供電的電源,其中,傳感器的感應(yīng)端抵接在人體肢體上,傳感器與中央處理模塊的第一輸入端電連接,中央處理模塊的輸出端與電機(jī)驅(qū)動(dòng)單元的輸入端電連接,電機(jī)驅(qū)動(dòng)單元的輸出端與電機(jī)的輸入端電連接;傳感器,用于檢測人體肢體部位在進(jìn)行手指運(yùn)動(dòng)時(shí)所產(chǎn)生的肌電信號(hào);中央處理模塊,用于根據(jù)傳感器檢測到的肌電信號(hào)向電機(jī)驅(qū)動(dòng)單元發(fā)出電機(jī)控制信號(hào);電機(jī)驅(qū)動(dòng)單元,用于根據(jù)電機(jī)控制信號(hào)驅(qū)動(dòng)電機(jī)運(yùn)轉(zhuǎn)。

上述中央處理模塊的輸出端可以為gpioa(通用輸入/輸出)通道端口,上述中央處理模塊的第一輸入端可以為a/d(模擬/數(shù)字)變換排序器通道端口。此外,電機(jī)可以為微型直流電機(jī)。

上述傳感器可以為肌電信號(hào)傳感器。人體肢體部位在進(jìn)行屈指以及展指運(yùn)動(dòng)時(shí),人體肢體部位的肌電信號(hào)分別會(huì)發(fā)生相應(yīng)的變化,利用肌電信號(hào)會(huì)發(fā)生相應(yīng)變化這一特性,可以將傳感器的感應(yīng)端抵接在人體肢體上,通過傳感器檢測人體肢體部位的肌電信號(hào)的變化,獲得人體肢體部位的動(dòng)作意愿。其中,人體肢體可以為人體手臂,例如,傳感器的感應(yīng)端可以抵接在對(duì)應(yīng)人體手臂的二頭肌部位或者對(duì)應(yīng)人體手臂的內(nèi)屈肌群部位。需要說明的是,人體肢體還可以為人體腿部,例如,傳感器的感應(yīng)端可以抵接在對(duì)應(yīng)腿部的股外側(cè)肌部位或者對(duì)應(yīng)腿部的脛骨前肌部位,也就是說,也可以通過人體的其他部位來控制機(jī)械手,并不限于手臂部分的肌肉。

下面介紹一下上述控制系統(tǒng)所控制的機(jī)械結(jié)構(gòu),機(jī)械手的主要?jiǎng)幼鳛榍负驼怪?,屈指和展指的主要?jiǎng)恿υ炊紒碜陨鲜鲭姍C(jī),具體地,作為一種可選的機(jī)械結(jié)構(gòu),可以將機(jī)械結(jié)構(gòu)的整體結(jié)構(gòu)設(shè)計(jì)為:電機(jī)輸出軸帶動(dòng)減速器的輸入軸運(yùn)轉(zhuǎn),通過減速器減速,減速器的輸出軸通過傳動(dòng)機(jī)構(gòu),來驅(qū)動(dòng)手指進(jìn)行屈指或者展指的運(yùn)動(dòng),其中,可以針對(duì)每個(gè)手指配備一個(gè)專門的電機(jī),也可以將全部手指通過一定電機(jī)來進(jìn)行驅(qū)動(dòng),在實(shí)際應(yīng)用中,較為優(yōu)選地,每個(gè)手指配備一個(gè)電機(jī),每個(gè)電機(jī)配有一個(gè)電機(jī)驅(qū)動(dòng)單元,中央處理模塊通過多個(gè)獨(dú)立的gpioa通道端口控制各個(gè)電機(jī)驅(qū)動(dòng)單元。屈指和展指的運(yùn)動(dòng),主要是靠控制電機(jī)的正轉(zhuǎn)和反轉(zhuǎn)來實(shí)現(xiàn)。其中,減速器的輸出軸與手指結(jié)構(gòu)之間的傳動(dòng)機(jī)構(gòu)可以采用渦輪蝸桿或者滑動(dòng)螺栓螺母的結(jié)構(gòu),這樣的結(jié)構(gòu)本身具有一定的自鎖功能,即在電機(jī)停止動(dòng)力輸出后,手指能保持住當(dāng)前的姿態(tài),從而可以實(shí)現(xiàn)對(duì)物體的抓握。

本發(fā)明實(shí)施例提供的機(jī)械手控制系統(tǒng),通過傳感器檢測人體控制手指動(dòng)作時(shí)所傳送的肌電信號(hào),由中央處理模塊根據(jù)傳感器檢測到的肌電信號(hào)向電機(jī)驅(qū)動(dòng)單元發(fā)出電機(jī)控制信號(hào),進(jìn)而由電機(jī)驅(qū)動(dòng)單元根據(jù)電機(jī)控制信號(hào)驅(qū)動(dòng)電機(jī)運(yùn)轉(zhuǎn)。本發(fā)明實(shí)施例能夠根據(jù)人體控制手指動(dòng)作時(shí)所傳送的肌電信號(hào)控制機(jī)械手動(dòng)作,實(shí)現(xiàn)機(jī)械手動(dòng)作的自動(dòng)化控制,便于對(duì)機(jī)械手進(jìn)行使用操作。

實(shí)施例二

如圖2和圖3所示,圖2是實(shí)施例二相對(duì)實(shí)施例一所增加的元件與實(shí)施例一中部分單元連接的原理示意圖,圖3為假肢手一個(gè)手指的控制系統(tǒng)的結(jié)構(gòu)示意圖。本實(shí)施例與實(shí)施例一不同之處在于,本實(shí)施例的機(jī)械手控制系統(tǒng)還可以包括用于檢測電機(jī)驅(qū)動(dòng)回路中電流值檢測元件,通過這樣的檢測元件可以實(shí)現(xiàn)一定程度的反饋控制。

在實(shí)際應(yīng)用中,在沒有反饋控制的情況下,機(jī)械手完全依靠人體手臂的肌電信號(hào)控制進(jìn)行相應(yīng)的動(dòng)作,當(dāng)抓取物體時(shí),需要機(jī)械手使用者自行預(yù)判機(jī)械手的抓取力度,容易發(fā)生力度過大將物體抓壞,或者力度過小導(dǎo)致物體在機(jī)械手中滑落。

為了防止上述問題的發(fā)生,本發(fā)明實(shí)施例在實(shí)施例一的基礎(chǔ)上作了進(jìn)一步改進(jìn),本實(shí)施例的機(jī)械手控制系統(tǒng)還可以包括檢測元件,電機(jī)的輸入端與電機(jī)驅(qū)動(dòng)單元的輸出端以及檢測元件的輸入端電連接,檢測元件的輸出端與中央處理模塊的第二輸入端電連接;檢測元件,用于檢測電機(jī)輸入端的電流值;中央處理模塊,用于根據(jù)檢測元件檢測到的電流值以及肌電信號(hào),向電機(jī)驅(qū)動(dòng)單元發(fā)出電機(jī)控制信號(hào)。其中,前述中央處理模塊的第三輸入端可以為a/d變換排序器通道端口。

這里所說的檢測元件用于檢測電機(jī)輸入端的電流值,是指,在實(shí)際應(yīng)用中,電機(jī)在通電狀態(tài)下,電機(jī)從正常轉(zhuǎn)動(dòng)狀態(tài)到機(jī)械手抓取物體并使得電機(jī)載荷狀態(tài)時(shí),電機(jī)的輸出扭矩逐漸增大,電機(jī)的轉(zhuǎn)速逐漸降低,電機(jī)輸出端的電流逐漸增大。為了使機(jī)械手正常工作,可以根據(jù)實(shí)際情況選擇電機(jī)的輸出扭矩范圍(可以限定一個(gè)最大扭矩值即可),作為電機(jī)正常運(yùn)轉(zhuǎn)和電機(jī)載荷運(yùn)轉(zhuǎn)并趨近于停止轉(zhuǎn)動(dòng)的界限??梢酝ㄟ^更換大扭矩的電機(jī)來改變電機(jī)的扭矩范圍,電機(jī)的輸出扭矩和電機(jī)輸入端的電流成正比,選擇好電機(jī)的臨界扭矩范圍之后,可以根據(jù)電流和扭矩之間成正比的關(guān)系,計(jì)算出電機(jī)輸入端的臨界電流范圍,可以在計(jì)算出的臨界電流范圍內(nèi)選取一個(gè)值作為預(yù)設(shè)電流值。通過檢測元件檢測電機(jī)輸出端的電流值,將檢測到的電流值和預(yù)設(shè)電流值進(jìn)行比較,得出比較結(jié)果,向電機(jī)驅(qū)動(dòng)單元發(fā)出電機(jī)控制信號(hào)。

上述檢測元件可以為電流檢測元件。其中,檢測元件可以設(shè)置在電機(jī)驅(qū)動(dòng)單元的內(nèi)部,當(dāng)然也可以單獨(dú)作為一個(gè)檢測單元。

上述中央處理模塊可以包括:控制單元以及比較單元,比較單元中設(shè)置有預(yù)設(shè)電流值,比較單元用于將電機(jī)輸入端的電流值與比較單元中設(shè)置的預(yù)設(shè)電流值相比較,并將比較結(jié)果發(fā)送給控制單元,控制單元用于根據(jù)傳感器檢測到的肌電信號(hào)和比較單元的比較結(jié)果,向電機(jī)驅(qū)動(dòng)單元發(fā)出電機(jī)控制信號(hào)。其中,傳感器的數(shù)量可以至少為兩個(gè),其中至少一個(gè)傳感器為檢測屈指肌電信號(hào)的第一傳感器,至少一個(gè)傳感器為檢測展指肌電信號(hào)的第二傳感器。本發(fā)明實(shí)施例中的傳感器的數(shù)量優(yōu)選為兩個(gè),這兩個(gè)傳感器其中一個(gè)設(shè)置在屈指動(dòng)作時(shí)產(chǎn)生肌電信號(hào)較多的肌肉部位,另一個(gè)設(shè)置在展指運(yùn)動(dòng)時(shí)產(chǎn)生肌電信號(hào)較多的部位,由于不同的殘疾人可能手臂截?cái)嗟牟课皇遣煌?,因此,?shí)際設(shè)置傳感器的部位可以因人而異,可以讓使用者首先嘗試做屈指和展指運(yùn)動(dòng),然后通過檢測儀器測試一下哪部分肌肉產(chǎn)生的肌電信號(hào)較多,然后再設(shè)置傳感器。作為一種簡便方式,可以讓使用者感覺一下在屈指和展指的過程中,哪部分肌肉在動(dòng),然后將傳感器設(shè)置于該部位即可,之后,可以在安裝機(jī)械手后,可以根據(jù)機(jī)械手的使用情況進(jìn)行調(diào)整即可。在實(shí)際使用中,一般可以將第一傳感器抵接在對(duì)應(yīng)手臂的二頭肌部位外側(cè),第二傳感器抵接在對(duì)應(yīng)手臂的二頭肌部位內(nèi)側(cè)。此外,在機(jī)械手結(jié)構(gòu)中,可以設(shè)置為電機(jī)正向轉(zhuǎn)動(dòng)時(shí)驅(qū)動(dòng)機(jī)械手的手指進(jìn)行屈指運(yùn)動(dòng),電機(jī)反向轉(zhuǎn)動(dòng)時(shí)驅(qū)動(dòng)機(jī)械手的手指進(jìn)行展指運(yùn)動(dòng),具體的電機(jī)正反轉(zhuǎn)設(shè)計(jì)可以根據(jù)具體機(jī)械結(jié)構(gòu)而定。

這里所說的當(dāng)檢測到肌電信號(hào)并且比較結(jié)果為電機(jī)輸入端的電流值小于或等于預(yù)設(shè)電流值的情況下,向電機(jī)驅(qū)動(dòng)單元發(fā)出使電機(jī)轉(zhuǎn)動(dòng)的電機(jī)控制信號(hào)包括:當(dāng)檢測到屈指肌電信號(hào)并且比較結(jié)果為電機(jī)輸入端的電流值小于或等于預(yù)設(shè)電流值的情況下,向電機(jī)驅(qū)動(dòng)單元發(fā)出使電機(jī)正向轉(zhuǎn)動(dòng)的電機(jī)控制信號(hào);當(dāng)檢測到展指肌電信號(hào)并且比較結(jié)果為電機(jī)輸入端的電流值小于或等于預(yù)設(shè)電流值的情況下,向電機(jī)驅(qū)動(dòng)單元發(fā)出使電機(jī)反向轉(zhuǎn)動(dòng)的電機(jī)控制信號(hào)。

此外,如圖3所示,供電電源的電壓可以為8v,可以通過電源交換電路將電源的供電電壓轉(zhuǎn)換為1.8v、3.3v以及5v,1.8v和3.3v的供電電壓通入中央處理模塊中,其中,1.8v的供電電壓用于為中央處理模塊中的控制單元以及比較單元供電;中央處理模塊中可以設(shè)置有用于使模擬信號(hào)與數(shù)字信號(hào)二者互相變換的a/d變換排序器,3.3v的供電電壓用于為中央處理模塊中的a/d變換排序器供電;5v的供電電壓用于為電機(jī)驅(qū)動(dòng)單元供電。

另外,上述中央處理模塊還可以包括顯示單元,機(jī)械手的手背上可以設(shè)置有用于安裝顯示單元的安裝孔,顯示單元通過安裝孔安裝在機(jī)械手手背上,顯示單元可以設(shè)置有顯示屏,顯示屏從安裝孔處露出機(jī)械手手背。比較單元可以基于電機(jī)輸入端的電流計(jì)算出當(dāng)前電機(jī)的扭矩。顯示單元可以與比較單元電連接,顯示單元將比較單元計(jì)算出的電機(jī)輸出扭矩顯示給機(jī)械手使用者。機(jī)械手使用者可以根據(jù)顯示單元顯示的電機(jī)輸出扭矩,結(jié)合待抓取物體外壁的實(shí)際承受載力,通過人體大腦控制停止向手臂神經(jīng)發(fā)送屈指意愿。

上述的中央處理模塊中的各個(gè)組成部分,可以由單獨(dú)的芯片構(gòu)成,可以將部分或者全部的單元由內(nèi)置程序的微處理器完成,例如,單片機(jī)、dsp等微處理器。

作為上述中央處理模塊組成結(jié)構(gòu)的一種可選方式,也可以將上述的中央處理模塊通過fpga等集成電路實(shí)現(xiàn)。

為了防止其他信號(hào)對(duì)檢測到的人體肌電信號(hào)造成干擾,本發(fā)明實(shí)施例的機(jī)械手控制系統(tǒng)還可以包括差動(dòng)放大電路以及濾波電路電連接,傳感器的輸出端可以與差動(dòng)放大電路的輸入端電連接,差動(dòng)放大電路的輸出端可以與濾波電路的輸入端電連接,濾波電路的輸出端可以與中央處理模塊的第一輸入端電連接;差動(dòng)放大電路,用于將傳感器的檢測到的肌電信號(hào)放大;濾波電路,用于過濾肌電信號(hào)中的交流成分。

為使中央處理模塊和電機(jī)驅(qū)動(dòng)單元二者之間的控制信號(hào)相適配,中央處理模塊的輸出端與電機(jī)驅(qū)動(dòng)單元的輸入端之間可以通過電平變換電路電連接,電平變換電路,用于將中央處理模塊的輸出端的電機(jī)控制信號(hào)轉(zhuǎn)化為與電機(jī)驅(qū)動(dòng)單元相適配的電機(jī)控制信號(hào),例如,中央處理模塊輸出的是0-3.3v電機(jī)控制信號(hào),驅(qū)動(dòng)單元只能在電機(jī)控制信號(hào)為5v時(shí)控制電機(jī)轉(zhuǎn)動(dòng),這時(shí)就需要電平變換電路將0-3.3v范圍內(nèi)的電機(jī)控制信號(hào)轉(zhuǎn)換為5v,以便于驅(qū)動(dòng)單元接收中央處理模塊發(fā)送的電機(jī)控制信號(hào)。此外,電機(jī)由轉(zhuǎn)動(dòng)狀態(tài)驟然停止時(shí),檢測元件的感應(yīng)端由通電狀態(tài)變?yōu)閿嚯姞顟B(tài),使得檢測元件中產(chǎn)生自感電動(dòng)勢,自感電動(dòng)勢的產(chǎn)生會(huì)導(dǎo)致檢測元件燒損。為了防止檢測元件燒損,檢測元件的輸出端與中央處理模塊的第二輸入端之間可以通過阻容網(wǎng)絡(luò)電路電連接,這里的阻容網(wǎng)絡(luò)電路也叫阻容瀉放電路,阻容網(wǎng)絡(luò)電路,用于吸收檢測元件電路斷開時(shí)產(chǎn)生的自感電動(dòng)勢,防止檢測元件被燒損。

本發(fā)明實(shí)施例的機(jī)械手控制系統(tǒng),通過檢測元件實(shí)時(shí)檢測電機(jī)的扭矩,實(shí)現(xiàn)三方面的有益效果:第一方面,能夠合理的輸出扭矩,節(jié)約電源電能;第二方面,能夠防止電機(jī)扭矩過大時(shí),造成電機(jī)損壞,有效的保護(hù)電機(jī);第三方面,合理的控制電機(jī)的扭矩,防止機(jī)械手將物體抓壞,以及防止機(jī)械手在抓取物體時(shí),物體在機(jī)械手中滑出,導(dǎo)致物體摔壞。機(jī)械手在抓取物體時(shí),給物體一個(gè)合適的摩擦力即可以對(duì)不同的物體進(jìn)行抓取,因此在實(shí)際使用中,可以選擇合適的電流預(yù)設(shè)值,通過比較單元的控制來進(jìn)行物體的抓取以及物體的釋放。

實(shí)施例三

如圖4所示,圖4為本發(fā)明實(shí)施例三所提供的機(jī)械手控制系統(tǒng)的使用狀態(tài)示意圖。本實(shí)施例將對(duì)本發(fā)明實(shí)施例的機(jī)械手控制系統(tǒng)的控制原理進(jìn)行詳細(xì)描述。圖4中,機(jī)械手的手掌內(nèi)部設(shè)置有空腔,中央處理模塊、電機(jī)、電機(jī)驅(qū)動(dòng)單元以及電源可以設(shè)置在機(jī)械手手掌的空腔內(nèi)。

機(jī)械手在展指狀態(tài)下抓握物體以及釋放物體的順序是:屈指-握緊物體-釋放物體并展指-伸直手指。人體在佩戴好本發(fā)明實(shí)施例的機(jī)械手之后,進(jìn)行如下動(dòng)作:

(1)屈指:傳感器檢測到人體發(fā)出屈指的肌電信號(hào),傳感器將屈指肌電信號(hào)傳送給中央處理模塊,中央處理模塊根據(jù)屈指肌電信號(hào)向電機(jī)驅(qū)動(dòng)單元發(fā)送屈指電機(jī)控制信號(hào),電機(jī)驅(qū)動(dòng)單元接收到屈指電機(jī)控制信號(hào)后控制電機(jī)進(jìn)行正轉(zhuǎn)運(yùn)動(dòng),即機(jī)械手進(jìn)行屈指動(dòng)作。與此同時(shí),檢測元件檢測電機(jī)輸入端的電流值,檢測元件將電機(jī)輸入端的電流值,傳送給比較單元,比較單元將電機(jī)輸入端的電流值與比較單元中設(shè)置的電流的預(yù)設(shè)范圍相比較,并將比較結(jié)果發(fā)送給控制單元,當(dāng)檢測到肌電信號(hào)并且比較結(jié)果為電機(jī)輸入端的電流值小于或等于預(yù)設(shè)電流值,向電機(jī)驅(qū)動(dòng)單元發(fā)出使電機(jī)正轉(zhuǎn)的電機(jī)控制信號(hào),電機(jī)繼續(xù)進(jìn)行正轉(zhuǎn)運(yùn)動(dòng),機(jī)械手繼續(xù)進(jìn)行屈指動(dòng)作;

(2)握緊物體:當(dāng)檢測到肌電信號(hào)并且比較結(jié)果為電機(jī)輸入端的電流值大于預(yù)設(shè)電流值,比較單元向電機(jī)驅(qū)動(dòng)單元發(fā)出使電機(jī)停止轉(zhuǎn)動(dòng)的電機(jī)控制信號(hào),電機(jī)停止轉(zhuǎn)動(dòng)。此時(shí)機(jī)械手已經(jīng)握住物體,并對(duì)物體的外壁施加了一定的壓力。由于機(jī)械手通過螺桿螺母雙層折回傳動(dòng)機(jī)構(gòu)傳動(dòng),螺桿螺母傳動(dòng)機(jī)構(gòu)具有自鎖功能。因此,在電機(jī)停止轉(zhuǎn)動(dòng)時(shí),機(jī)械手能夠停在當(dāng)前握緊物體的狀態(tài)。

(3)釋放物體并展指:傳感器檢測到人體發(fā)出釋放物體并展指的肌電信號(hào),傳感器將釋放物體并展指的肌電信號(hào)傳送給中央處理模塊,中央處理模塊根據(jù)釋放物體并展指肌的電信號(hào)向電機(jī)驅(qū)動(dòng)單元發(fā)送釋放物體并展指的電機(jī)控制信號(hào),電機(jī)驅(qū)動(dòng)單元接收到釋放物體并展指的電機(jī)控制信號(hào)后控制電機(jī)進(jìn)行反轉(zhuǎn)運(yùn)動(dòng),即機(jī)械手進(jìn)行展動(dòng)作。與此同時(shí),檢測元件檢測電機(jī)輸入端的電流值,檢測元件將電機(jī)輸入端的電流值,傳送給比較單元,比較單元將電機(jī)輸入端的電流值與比較單元中設(shè)置的電流的預(yù)設(shè)范圍相比較,并將比較結(jié)果發(fā)送給控制單元,當(dāng)檢測到釋放物體并展指的肌電信號(hào)并且比較結(jié)果為電機(jī)輸入端的電流值小于或等于預(yù)設(shè)電流值,向電機(jī)驅(qū)動(dòng)單元發(fā)出使電機(jī)反轉(zhuǎn)的電機(jī)控制信號(hào),電機(jī)繼續(xù)進(jìn)行反轉(zhuǎn)運(yùn)動(dòng),機(jī)械手繼續(xù)進(jìn)行展指動(dòng)作。

(4)伸直手指:當(dāng)檢測到肌電信號(hào)并且比較結(jié)果為電機(jī)輸入端的電流值大于預(yù)設(shè)電流值,比較單元向電機(jī)驅(qū)動(dòng)單元發(fā)出使電機(jī)停止轉(zhuǎn)動(dòng)的電機(jī)控制信號(hào),電機(jī)停止轉(zhuǎn)動(dòng)。此時(shí)機(jī)械手的手指已經(jīng)處于伸直狀態(tài)。由于機(jī)械手通過螺桿螺母雙層折回傳動(dòng)機(jī)構(gòu)傳動(dòng),螺桿螺母傳動(dòng)機(jī)構(gòu)具有自鎖功能。因此,在電機(jī)停止轉(zhuǎn)動(dòng)時(shí),機(jī)械手能夠停在當(dāng)前伸直手指的狀態(tài)。

實(shí)施例四

如圖5所示,本實(shí)施例在上述各實(shí)施例的基礎(chǔ)上,增加了手指模式切換開關(guān)。具體地,本實(shí)施例的機(jī)械手控制系統(tǒng)中,電機(jī)的數(shù)量為多個(gè),相應(yīng)地,電機(jī)驅(qū)動(dòng)單元也為多個(gè),每個(gè)電機(jī)分別對(duì)應(yīng)一個(gè)電機(jī)驅(qū)動(dòng)單元。手指模式控制開關(guān)與中央處理模塊的第三輸入端電連接,用于向中央處理模塊輸入用于切換預(yù)設(shè)的手指模式的模式切換信號(hào),手指模式切換開關(guān)的物理按鍵設(shè)置在機(jī)械手的外表面,用戶通過手動(dòng)的方式進(jìn)行手指模式的切換控制,相應(yīng)地,中央處理模塊根據(jù)傳感器檢測到的肌電信號(hào)和模式切換信號(hào),向電機(jī)驅(qū)動(dòng)單元發(fā)出電機(jī)控制信號(hào)。這里的模式切換信號(hào)可以高電平、低電平或者預(yù)設(shè)的脈沖形式的信號(hào)中的一種或者多種組合,也可以是手指模式切換開關(guān)處于斷開狀態(tài)的無信號(hào)狀態(tài)(也就是說沒有信號(hào)輸入本身也可以是一種模式切換信號(hào)),總之,在具體的電路實(shí)現(xiàn)中,能夠區(qū)分出不同的模式切換信號(hào)即可。手指模式切換開關(guān)也不限于開和關(guān)兩種狀態(tài),可以是多種狀態(tài)的選擇,就想汽車的檔位一樣。在程序設(shè)計(jì)上,可以采用根據(jù)模式切換信號(hào)選擇具體的手指模式的方式,也可以采用中央處理模塊中記錄一個(gè)當(dāng)前使用的手指模式,然后在每次操作手指模式切換開關(guān)后,觸發(fā)當(dāng)前使用的手指模式的變換。

進(jìn)一步地,手指的動(dòng)作最終還是由電機(jī)驅(qū)動(dòng)的,因此,手指模式主要還是具體電機(jī)的模式,可以包括各個(gè)電機(jī)的轉(zhuǎn)速的不同組合所形成的多個(gè)手指模式和/或各個(gè)電機(jī)的扭矩的不同組合所形成的多個(gè)手指模式,或者是各個(gè)電機(jī)開啟或者關(guān)閉狀態(tài)的組合,這里所說的開啟是指電機(jī)處于可接收指令或者說是驅(qū)動(dòng)信號(hào)并且可以運(yùn)轉(zhuǎn)的狀態(tài),而關(guān)閉是指電機(jī)無論是否接收到指令或者驅(qū)動(dòng)信號(hào)均不會(huì)運(yùn)轉(zhuǎn)。例如,可以通過將各個(gè)電機(jī)的轉(zhuǎn)速設(shè)置為不同,可以在進(jìn)行屈指或者展指運(yùn)動(dòng)時(shí),呈現(xiàn)不同的手指形態(tài),并且在停止進(jìn)行屈指或者展指運(yùn)動(dòng)后,還可以保持住相應(yīng)的形態(tài),從而拓展手指使用功能,以適應(yīng)不同的應(yīng)用場景。再例如,通過將各個(gè)電機(jī)的扭矩設(shè)置為不同,也可以在對(duì)物體抓握時(shí),對(duì)不同部位實(shí)現(xiàn)不同的抓握力,從而也能拓展手指的使用功能,以適應(yīng)不同的應(yīng)用場景。再例如,通過設(shè)置各個(gè)電機(jī)的不同的開啟或者關(guān)閉狀態(tài),僅讓個(gè)別手指運(yùn)動(dòng),同樣可以實(shí)現(xiàn)不同的手指形態(tài)。

在中央處理模塊中,具體可以通過如下方式實(shí)現(xiàn),中央處理模塊中設(shè)置有預(yù)設(shè)的多個(gè)手指模式的模式控制信息,模式控制信息包括各個(gè)電機(jī)的轉(zhuǎn)速和/或扭矩,或者各個(gè)電機(jī)的關(guān)閉和/或啟動(dòng)的狀態(tài),

上述的中央處理模塊根據(jù)傳感器檢測到的肌電信號(hào)和模式切換信號(hào),向電機(jī)驅(qū)動(dòng)單元發(fā)出電機(jī)控制信號(hào)可以具體包括:中央處理模塊先根據(jù)模式切換信號(hào)選擇模式控制信息,并根據(jù)傳感器檢測到的肌電信號(hào)和模式控制信息向電機(jī)驅(qū)動(dòng)單元發(fā)出電機(jī)控制信號(hào)。

具體的,手指模式控制開關(guān)的物理按鍵設(shè)置在機(jī)械手的外表面,如圖6所示,具體可以設(shè)置在機(jī)械手的腕部,從而不會(huì)對(duì)手指運(yùn)動(dòng)造成影響。上述提及的物理按鍵可以是按鈕形態(tài)也可以是撥動(dòng)開關(guān)等形態(tài),本領(lǐng)域技術(shù)人員應(yīng)當(dāng)理解,只要是能夠?qū)崿F(xiàn)開關(guān)控制的物理結(jié)構(gòu)都屬于本發(fā)明實(shí)施例中所提及的物理按鍵的范疇。具體地,作為一個(gè)通用的機(jī)械手,電機(jī)的數(shù)量為5個(gè),分別對(duì)應(yīng)驅(qū)動(dòng)5個(gè)機(jī)械手指的動(dòng)作。

此外,在具體的切換控制的實(shí)現(xiàn)上,還可以將多種手指模式進(jìn)行分類或者說是分組,手指模式切換開關(guān)僅僅是在各個(gè)類別中進(jìn)行切換,然后再輔助其他控制條件進(jìn)行具體的手指模式切換。例如,將手指模式分為大拇指與一般手指(大拇指以外的手指,大拇指可以分別和各個(gè)手指進(jìn)行排列組合,例如包括大拇指和其他四指聯(lián)動(dòng),和其他三指聯(lián)動(dòng)……)聯(lián)動(dòng)和各個(gè)手指單獨(dú)運(yùn)動(dòng)(例如一共五個(gè)手指,共包含5中手指模式)這兩類,然后再通過其他控制條件,在具體類別中進(jìn)行選擇。這里所說的其他條件可以是,例如,進(jìn)行展指動(dòng)作到最大程度(手指完全展開),手指電機(jī)由于到達(dá)極限狀態(tài)電機(jī)停止工作(結(jié)合實(shí)施例二中的檢測元件),如果在這樣的狀態(tài)下,展指的肌電信號(hào)仍然持續(xù)超過預(yù)設(shè)時(shí)間,則觸發(fā)一次在具體類別中的手指模式切換。

另外,本實(shí)施例的手指模式切換開關(guān)可以與上述各實(shí)施例的電路模塊結(jié)構(gòu)融合為一體進(jìn)行工作。具體地,結(jié)合上述各實(shí)施例的電路模塊結(jié)構(gòu),在機(jī)械手控制系統(tǒng)包括上述檢測元件的情況下,如實(shí)施例二所說明的,電機(jī)的輸入端與電機(jī)驅(qū)動(dòng)單元的輸出端以及檢測元件的輸入端電連接,檢測元件的輸出端與中央處理模塊的第二輸入端電連接,檢測元件,用于檢測電機(jī)輸入端的電流值。

在這樣電路結(jié)構(gòu)下,中央處理模塊具體用于根據(jù)檢測元件檢測到的電流值、肌電信號(hào)以及模式切換信號(hào),向電機(jī)驅(qū)動(dòng)單元發(fā)出電機(jī)控制信號(hào)。

進(jìn)一步地,中央處理模塊可以包括:控制單元、比較單元以及模式選定單元,

比較單元中設(shè)置有預(yù)設(shè)電流值,比較單元用于將電機(jī)輸入端的電流值與比較單元中設(shè)置的預(yù)設(shè)電流值相比較,并將比較結(jié)果發(fā)送給控制單元,

模式選定單元中設(shè)置有預(yù)設(shè)的多個(gè)手指模式的模式控制信息,模式選定單元用于根據(jù)模式切換信號(hào)選擇模式控制信息,并將模式控制信息發(fā)送給控制單元,模式控制信息包括各個(gè)電機(jī)的轉(zhuǎn)速和/或扭矩,或者各個(gè)電機(jī)的關(guān)閉和/或啟動(dòng)的狀態(tài),

控制單元用于根據(jù)傳感器檢測到的肌電信號(hào)、比較單元的比較結(jié)果以及模式控制信息,向電機(jī)驅(qū)動(dòng)單元發(fā)出電機(jī)控制信號(hào)。

更進(jìn)一步地,據(jù)傳感器檢測到的肌電信號(hào)和比較單元的比較結(jié)果以及模式控制信息,向電機(jī)驅(qū)動(dòng)單元發(fā)出電機(jī)控制信號(hào)可以包括:

當(dāng)檢測到肌電信號(hào)并且比較結(jié)果為電機(jī)輸入端的電流值小于或等于預(yù)設(shè)電流值的情況下,根據(jù)模式控制信息向電機(jī)驅(qū)動(dòng)單元發(fā)出使電機(jī)轉(zhuǎn)動(dòng)的電機(jī)控制信號(hào);

當(dāng)檢測到肌電信號(hào)并且比較結(jié)果為電機(jī)輸入端的電流值大于預(yù)設(shè)電流值的情況下,向電機(jī)驅(qū)動(dòng)單元發(fā)出使電機(jī)停止轉(zhuǎn)動(dòng)的電機(jī)控制信號(hào)。

更進(jìn)一步地,傳感器至少為兩個(gè),其中至少一個(gè)傳感器為檢測屈指肌電信號(hào)的第一傳感器,至少一個(gè)傳感器為檢測展指肌電信號(hào)的第二傳感器,電機(jī)正向轉(zhuǎn)動(dòng)時(shí)驅(qū)動(dòng)手指進(jìn)行屈指運(yùn)動(dòng),電機(jī)反向轉(zhuǎn)動(dòng)時(shí)驅(qū)動(dòng)手指進(jìn)行展指運(yùn)動(dòng),

當(dāng)檢測到肌電信號(hào)并且比較結(jié)果為電機(jī)輸入端的電流值小于或等于預(yù)設(shè)電流值的情況下,根據(jù)模式控制信息向電機(jī)驅(qū)動(dòng)單元發(fā)出使電機(jī)轉(zhuǎn)動(dòng)的電機(jī)控制信號(hào)包括:

當(dāng)檢測到屈指肌電信號(hào)并且比較結(jié)果為電機(jī)輸入端的電流值小于或等于預(yù)設(shè)電流值的情況下,根據(jù)模式控制信息向電機(jī)驅(qū)動(dòng)單元發(fā)出使電機(jī)正向轉(zhuǎn)動(dòng)的電機(jī)控制信號(hào);

當(dāng)檢測到展指肌電信號(hào)并且比較結(jié)果為電機(jī)輸入端的電流值小于或等于預(yù)設(shè)電流值的情況下,根據(jù)模式控制信息向電機(jī)驅(qū)動(dòng)單元發(fā)出使電機(jī)反向轉(zhuǎn)動(dòng)的電機(jī)控制信號(hào)。本領(lǐng)域普通技術(shù)人員可以理解:實(shí)現(xiàn)上述各方法實(shí)施例的全部或部分步驟可以通過程序指令相關(guān)的硬件來完成。前述的程序可以存儲(chǔ)于一計(jì)算機(jī)可讀取存儲(chǔ)介質(zhì)中。該程序在執(zhí)行時(shí),執(zhí)行包括上述各方法實(shí)施例的步驟;而前述的存儲(chǔ)介質(zhì)包括:rom、ram、磁碟或者光盤等各種可以存儲(chǔ)程序代碼的介質(zhì)。

最后應(yīng)說明的是:以上各實(shí)施例僅用以說明本發(fā)明的技術(shù)方案,而非對(duì)其限制;盡管參照前述各實(shí)施例對(duì)本發(fā)明進(jìn)行了詳細(xì)的說明,本領(lǐng)域的普通技術(shù)人員應(yīng)當(dāng)理解:其依然可以對(duì)前述各實(shí)施例所記載的技術(shù)方案進(jìn)行修改,或者對(duì)其中部分或者全部技術(shù)特征進(jìn)行等同替換;而這些修改或者替換,并不使相應(yīng)技術(shù)方案的本質(zhì)脫離本發(fā)明各實(shí)施例技術(shù)方案的范圍。

當(dāng)前第1頁1 2 
網(wǎng)友詢問留言 已有0條留言
  • 還沒有人留言評(píng)論。精彩留言會(huì)獲得點(diǎn)贊!
1