孫旖彤,潘肖楠,張 俊,李明明,雷達榮
(1.隴東學院,甘肅 慶陽 745000;2.長慶油田分公司第十一采油廠,甘肅 慶陽 745000;3.慶陽質(zhì)量檢驗檢測研究院,甘肅 慶陽 745000)
我國蘋果的生產(chǎn)量巨大,一年的總產(chǎn)量大概有3 000 萬t。在整個蘋果產(chǎn)業(yè)生產(chǎn)中,采摘過程占全部所需勞動力的三分之一至二分之一。但是,目前大部分的蘋果采用的是人工采摘,采摘的效率非常低,而且耗費的勞動力比較大,在采摘的過程中還會遇到一些不可預知的危險。因此機械自動化采摘尤為重要。
針對市面上一些輔助機器易損傷、效率低的問題,本文研究的蘋果采摘機械手是一種自動化的水果采摘機械手,通過控制系統(tǒng)和機械結(jié)構(gòu)的自動操作就可以完成采摘蘋果的工作,這樣大大提高了勞動效率,對促成蘋果產(chǎn)業(yè)的發(fā)展具有重要的運用價值。
蘋果采摘機器人經(jīng)過多年的發(fā)展,其驅(qū)動部分主要有液壓、氣壓、電機驅(qū)動,而手指結(jié)構(gòu)設計分為兩指和多指。本文中研究的機械手爪采取三指,利用電機進行驅(qū)動。
通過分析采摘機械手裝置的機械原理,本文采取電機控制剛性連桿帶動其運動的連桿驅(qū)動型手爪,其裝置主要由電機、絲杠、軸承等零件組成。
電機采用絲杠步進電機,絲杠與螺母結(jié)合,絲杠作為主動體,當絲杠轉(zhuǎn)動時,螺母就會隨之轉(zhuǎn)換為直線移動,螺母連接著支持連桿使其運動,最后帶動機械手抓取蘋果。
當機械臂到達蘋果的位置時,發(fā)出信號給控制系統(tǒng),使其驅(qū)動步進電機進行正轉(zhuǎn),帶動螺桿轉(zhuǎn)動使螺母上升,同時帶動連桿也上升,然后機械手握緊,抓住蘋果,而當機械臂到達放置蘋果的位置時,單片機驅(qū)動步進電機反轉(zhuǎn),螺母下降,同時也伴隨著機械手張開,放置蘋果。而在機械手張開和握緊期間,通過螺桿的自鎖能力使機械手關節(jié)不會受蘋果重力而張開,裝配圖如圖1 所示。
圖1 裝配圖
手指部分包括近端關節(jié)和末端關節(jié),設計執(zhí)行機構(gòu)時要考慮采摘過程中是否會對果實造成傷害,為了盡可能降低對果實造成的傷害,決定在末端關節(jié)的內(nèi)側(cè)裝上較為柔軟的尼龍材料。
近端關節(jié)材質(zhì)為鋁合金;末端關節(jié)材質(zhì)為尼龍材料。
手指部分包括近端關節(jié)、末端關節(jié),為了使機械結(jié)構(gòu)易于制作,因此采用曲柄滑塊結(jié)構(gòu),連桿簡圖如圖2所示。
圖2 連桿簡圖
1.2.1 運動分析
1)尋找瞬心P13。對于直接連接的桿件,其瞬心可直接判斷出P12P34P23瞬心。P12是構(gòu)件1、2 的瞬心,P14是構(gòu)件1、4 的瞬心,P34是構(gòu)件3、4 的瞬心。
對于兩構(gòu)件未直接相連的,其瞬心利用三心定理進行判斷,延長1、2 桿和垂直于桿1 的點,可判斷出瞬心P13。
2)求角速度與螺桿速度關系
作圖分析,可得出以下公式
式中:IP12P34為P12到P34的距離,W3為P13的角速度。又因為P13是構(gòu)件1、3 的瞬心,根據(jù)式(1)和式(2)可得。
機械手第一個關節(jié)末的位置如圖3 所示,在坐標系O-xyz 中 為 點A(0,y1,z1),O'O=l1,sin120°=0.78,cos120°=-0.5。
圖3 第一個手指位置圖
對于O'-x'yz'坐標系,A 點對應的坐標為A'(0,l1+y1,z1)
利用H 變換矩陣,分別沿z 軸旋轉(zhuǎn)120°為另外2個機械手手指的坐標
因為空間坐標中的O'A,O'B,O'C 大小相等,且為繞z 軸旋轉(zhuǎn)120°所得,所以3 點連線為一個正三角形,如圖4 所示。
圖4 蘋果橫切面簡圖
由公式
可求得手指末端關節(jié)長度
蘋果高度一般為50~110 mm,直徑在50~110 mm,為機械手指尺寸提供依據(jù)。
由R≥55,z1≥55,已知l1=40,z1選取為60,OA選取為80。
機械手夾持蘋果重量為100~400 g,對其受力分析如圖5 所示。
圖5 受力分析圖
機械手另外2 個第二關節(jié)的受力處根據(jù)三力平衡匯交定理,可合成為力F2與F1,其匯交于一點,F(xiàn)a為螺母向上的推力,構(gòu)成三力平衡,可得公式
三指對蘋果的力可表示為FAFBFC,利用三力平衡匯交定理,F(xiàn)AFB的合力FN與FC平衡,所以根據(jù)公式2FNμ≥mgk1,可求得
由尼龍材料的摩擦系數(shù)μ=0.15~0.25,取μ=0.2,安全系數(shù)k1取1.5,a=30°;蘋果重量選擇0.4 kg 進行計算;求得FN≥14.7 N,因此選擇夾持力為15 N,求得驅(qū)動力Fa≈47.3 N。
手掌處主要是螺桿的設計及計算,本文中采用滑動螺旋傳動,其結(jié)構(gòu)簡單,成本低廉,并且相較于滾動螺旋傳動,滑動螺旋傳動有自鎖能力;因此本部分主要進行滑動螺旋傳動中螺桿螺母尺寸的選擇、強度校核、自鎖性驗算以及穩(wěn)定性校核,其螺桿示意如圖6 所示。
圖6 螺桿圖
1.5.1 絲杠軸向載荷力的計算
螺桿上方重量為m=2 kg。
軸向載荷公式如下
由式(8)進行計算得F≈67 N,因此選取軸向載荷力F=70 N,最為合適。
1.5.2 選材以及許用應力計算
螺桿螺母都采用45 號鋼,選擇梯形螺紋,其牙形角為30°,因此由《機械設計手冊》,可取σp為360 MPa,由
可取許用拉壓力σp=90 MPa。
因為機械手上升運動為低速運動,因此查《機械設計手冊》得螺桿對螺母的許用壓強[p]=7.5~13 MPa,取值為10 MPa。
1.5.3 螺紋尺寸選擇及校驗
螺紋尺寸取值,見表1。
表1 螺紋尺寸 mm
由耐磨性校驗螺紋中徑是否合適:
當螺紋為整體式時,螺紋升角系數(shù)(ψ)取1.2~2.5,取ψ=1.5。
依據(jù)《機械設計手冊》梯形螺紋,取ξ=0.8,F(xiàn)=70 N。
由公式可計算出螺紋中徑
所以螺紋中徑選擇為9 mm,上表尺寸數(shù)據(jù)合適。
因此,基本牙型高度
螺母高度
旋合圈數(shù)
選取中等精度,螺旋副標記為Tr10×2—7H。
1.5.4 自鎖性校驗
導程P=2 mm,查《機械設計手冊》表12-1-4,可得螺紋升角
查《機械設計手冊》表12-1-7,可得f=0.15~0.17,取值0.17,得
因為λ<ρ,所以自鎖可靠。
1.5.5 驅(qū)動轉(zhuǎn)矩計算
由公式
計算出驅(qū)動轉(zhuǎn)矩T=70.277(N·mm)。
手腕主要結(jié)構(gòu)是安裝電機,以及對接機械手臂,對其材料有一定要求,而果農(nóng)采摘水果時,還可能會遇到惡劣天氣,因此材料需要一定強度和耐腐蝕性。
鋁合金材料質(zhì)量輕,強度夠,耐腐蝕且價格低廉,所以材料采用鋁合金。
硬件是由主機、接口電路及外部設備組成。其相應的示意圖如圖7 所示。
圖7 控制系統(tǒng)硬件示意圖
機械手及其末端執(zhí)行器在運動時需要各種傳感器進行輔助,但因個人知識水平有限,因此本文只對其中的單片機、力傳感器、電機部分進行相關選用及設計。
2.2.1 RP-C 電阻式壓敏傳感器
人手摘取蘋果時,是通過皮膚和眼睛把消息傳遞給大腦,實現(xiàn)抓取;與此相同,機械手實現(xiàn)抓取動作,需要傳感器把信號傳遞給單片機,隨后單片機控制電機進行轉(zhuǎn)動,帶動執(zhí)行裝置完成抓取蘋果功能。
本文選用的壓力傳感器是RP-C10-ST 薄膜壓力傳感器,這是一種直徑為10 mm 的圓形柔性傳感器,由綜合機械性能優(yōu)異的聚酯薄膜,高導電材料和納米級壓力敏感材料組成,由曲線圖查表獲得Rx和F 的關系式
因為蘋果壓力小于20 N 時,表皮沒有損傷,但如果超過20 N,蘋果表皮雖然沒有直接損壞,但內(nèi)部出現(xiàn)組織損壞。為了使蘋果采摘時不被損壞,則手指的壓力不應該超過20 N。
依據(jù)曲線可以看出,隨著壓力的增大,電阻不斷變小,因此傳感器輸出的電阻應該大于26.6 Ω。
2.2.2 壓力傳感器應用電路
壓力傳感器輸入信號,單片機要檢測到該信號時,需要相應電路進行該信號的放大與轉(zhuǎn)化;應用電路主要使用電阻分壓器,然后把分壓的電壓輸入電壓比較器中,然后通過設計使其輸出高低電平,最后連接相關單片機串口,使單片機進行步進電機啟停的控制。
1)電阻分壓器。電源電壓為5 V,傳感器可以等效為一個可變電阻,其串聯(lián)一個R1=20 Ω 的電阻,整個電路起到分壓的作用。
輸出電流
分壓電壓
由上公式可推導出
其曲線圖如圖8 所示。
圖8 電壓/力關系圖
2)電壓比較器。UP處接入VN口,VE接一個比較的電壓,當VN>VE時,比較器不導通,輸入5 V 電壓作為高電壓;反之,當VN<VE時,比較器導通,輸出低電壓。
蘋果抓取的力一般不會超過15 N,其為了采摘蘋果時不損壞果皮,按照曲線圖,電壓不應該大于2.1 V,但為了單片機在手抓取時發(fā)出信號,使電機停止轉(zhuǎn)動,應該使VE接一個1.9 V 的電壓。
當UP電壓超過1.9 V 時,電壓比較器輸出高電壓,單片機接口檢測出數(shù)值為“1”,電機停止轉(zhuǎn)動,螺母自鎖使機械手抓取的蘋果不會掉落。
在本次蘋果采摘機械手的控制系統(tǒng)中,選擇AT89C51 單片機,其通過IO 口輸出的具有時序的方波作為對機械手控制動作的信號,這一方波信號會通過芯片LN298,進行信號放大,然后驅(qū)動步進電機以此來實現(xiàn)機械手的摘取動作。
AT89C51 單片機與MCS-51 單片機兼容,價格便宜,IO 口的操作簡單,指令簡單,極其適合用于作為本文控制部分的設計。
本次設計的蘋果采摘機械手的驅(qū)動部件是由電機實現(xiàn)的,因此電機的選擇是整個結(jié)構(gòu)設計和控制系統(tǒng)設計的關鍵。常見的機器人的運動形式在于對步進電機的控制和驅(qū)動,為了設計的方便,此次設計選擇電機為四相的步進電機(內(nèi)阻33 Ω,步進角度1.8°,額定電壓12 V)。
想要驅(qū)動電機,必須需要響應的驅(qū)動電路,因此使用LN298 芯片,不僅可以充分發(fā)揮了步進電機的功能,能穩(wěn)定地驅(qū)動步進電機,而且從經(jīng)濟考慮,價格不高,其可以直接用單片機模擬出時序信號,控制不復雜。
本文步進電機步距角為1.8°,螺桿導程為2 mm,所以單片機需要發(fā)出200 個脈沖,螺桿螺母將轉(zhuǎn)動一周,其簡單的系統(tǒng)結(jié)構(gòu)圖如圖9 所示。
圖9 步進電機控制系統(tǒng)結(jié)構(gòu)圖
如圖10 所示,單片機對EN A、EN B 口發(fā)送方波脈沖信號,接P3.4、P3.5 引腳,IN1~IN4 接AT89C51 單片機P0.0~P0.3 口;單片機接受到力傳感器和位置信號后,通過輸出脈沖,然后經(jīng)過LN298 芯片信號放大,實現(xiàn)電機正反轉(zhuǎn)以及啟停。
圖10 電機接線圖
在機械手裝配過程中與其他裝配過程大致相同,在裝配時,需要選擇合理的連接方式,使后期仿真順利進行,因此選用銷釘、滑塊等方式進行裝配,其裝配圖先進行手指部分,然后進行總裝配。
為了使設計的產(chǎn)品能夠合理地進行運動以及實現(xiàn)需要的功能,在設計中往往會進行仿真分析,本文利用creo4.0 進行仿真分析,其仿真分析過程如下。①打開已經(jīng)裝配好的機械手爪,點擊“應用程序”,運行“機構(gòu)”命令。②點擊電動機,為機械手添加驅(qū)動裝置。③進行機構(gòu)分析,點擊運行。④點擊“回放”,然后打開“動畫”界面。⑤打開“動畫”界面后,選擇播放查看仿真是否合適,隨后點擊“捕獲”,選擇保存路徑,點擊保存的視頻類型,隨后點擊確定,最后就能夠獲得仿真動畫視頻。⑥曲線圖繪制。點擊測量,進行新建測量定義,輸入需要測量的角速度連接軸,點擊圖形工具,曲線圖如圖11 所示。
圖11 角速度圖
蘋果人工采摘作業(yè)季節(jié)性強、人工成本高、勞動強度大,是蘋果生產(chǎn)鏈中最耗時、最費力的一個環(huán)節(jié)。因此,研制一款蘋果采摘機器人具有重要的經(jīng)濟意義,能夠有效降低工人勞動強度,提高生成效率,保證蘋果及時采收。通過對蘋果采摘機器人手指和手掌進行結(jié)構(gòu)設計,尺寸計算和受力分析,完成了蘋果采摘機械手的整體方案,并進行了控制系統(tǒng)的設計和簡單的仿真,驗證了該機械手的設計合理性,零件的結(jié)構(gòu)要素符合預期的設計目標,為下一步的步態(tài)規(guī)劃和樣機研制奠定了基礎。