郭永興,楊躍輝,熊 麗
(1.武漢科技大學(xué) 冶金裝備及其控制教育部重點(diǎn)實(shí)驗(yàn)室,湖北 武漢430081;2.武漢科技大學(xué) 機(jī)械傳動(dòng)與制造工程湖北省重點(diǎn)實(shí)驗(yàn)室,湖北 武漢430081)
軟體機(jī)器人是近年來的研究熱點(diǎn)。相比于傳統(tǒng)采用電機(jī)驅(qū)動(dòng)的剛性機(jī)器人,軟體機(jī)器人采用具有良好柔韌性和適應(yīng)性[1-2]的柔軟材料制成,能在各種非結(jié)構(gòu)化環(huán)境內(nèi)改變自身的方向和形態(tài)[3-4]。因此,軟體機(jī)器人技術(shù)在柔性仿生機(jī)器人、可穿戴柔性產(chǎn)品等領(lǐng)域體現(xiàn)出巨大的應(yīng)用前景。與此同時(shí),基于軟體機(jī)器人柔性驅(qū)體自身的靈活和柔韌特性,在受到受外載荷、自身重力以及環(huán)境接觸物的作用時(shí)它易發(fā)生不規(guī)則形變。因此,搭載形狀傳感器準(zhǔn)確反饋柔性驅(qū)體的形狀信息,是實(shí)現(xiàn)軟體機(jī)器人精準(zhǔn)控制的重要環(huán)節(jié)。
然而,傳統(tǒng)的基于電磁原理的應(yīng)變傳感器[5-6],存在體積大、剛度大、零點(diǎn)溫度漂移、弱電信號易受干擾及生物相容性差[7-8]等缺點(diǎn),與軟體機(jī)器人融合時(shí)難以滿足柔性機(jī)器人的形狀測量要求。光纖布拉格光柵(Fiber Bragg Grating,F(xiàn)BG)具備良好的柔韌性和彈性[9],加之易于植入集成[10-11]、耦合性好和串接穩(wěn)定性高[12-13]等優(yōu)勢,使得FBG成為柔性機(jī)器人形狀測量的首選傳感元件。
基于FBG的獨(dú)特優(yōu)勢,眾多學(xué)者對FBG軟體機(jī)器人形狀測量技術(shù)進(jìn)行了研究。Li等人[14]提出了一種基于平行雙FBG陣列的不規(guī)則截面的柔性機(jī)械臂分布式曲率傳感和形狀重構(gòu)方法。Wang等人[15]將FBG嵌入硅橡膠中,提出了一種基于FBG的形狀傳感算法和傳感網(wǎng)絡(luò)。Yi等人[16]介紹了一種正交曲率FBG傳感器陣列,用于監(jiān)測桿、龍骨等柔性結(jié)構(gòu)的變形和振動(dòng)。張潤璽等人[17]提出一種針對仿章魚軟體機(jī)器人的形狀控制算法。Wei等人[18]提出了一種新穎的單光纖螺旋結(jié)構(gòu)加多FBG傳感器來測量柔性機(jī)器人的形狀。He等人[19]提出了一種嵌入式FBG的軟手術(shù)執(zhí)行器三維形狀感知算法。當(dāng)然,也有不少學(xué)者為測量物體表面曲率,對基于FBG的曲率傳感器進(jìn)行了研究。鄭狄等人[20]設(shè)計(jì)了一種多芯FBG曲率傳感器,并采用匹配濾波技術(shù)實(shí)現(xiàn)曲率解調(diào)。Zhang等人[21]將FBG嵌入硅橡膠中,提出了一種基于FBG的軟曲率傳感器。何彥霖等人[22]提岀并設(shè)計(jì)了基于聚氯乙烯(Polyvi?nyl Chloride,PVC)和硅膠復(fù)合基底的FBG柔性曲率傳感器。Ge等人[23]將FBG偏心植入到凝膠中研制了一個(gè)雙向曲率傳感器。許西寧等人[24]利用光纖在不同彎曲曲率下的不同形變,提出并驗(yàn)證了一種基于七芯光纖和少模光纖的新型光纖曲率傳感器。Sun等人[25]將FBG融入軟硅-聚氯乙烯混合基底,提出了一種軟曲率傳感器。以上這些探索工作推動(dòng)了軟體機(jī)器人的發(fā)展,并為軟體機(jī)器人的形狀測量提供了參考。但是,大多數(shù)基于FBG的軟體機(jī)器人形狀傳感器研究均是沿著纖維方向的線狀形狀重建,只能實(shí)現(xiàn)多點(diǎn)曲線形狀傳感,不能實(shí)現(xiàn)多點(diǎn)曲面形狀傳感。其次,大多數(shù)報(bào)道只實(shí)現(xiàn)了單方向純彎曲形狀測量,并沒有實(shí)現(xiàn)復(fù)雜曲面的形狀測量。此外,相關(guān)研究多數(shù)采用PVC、聚酰亞胺等剛性材料作為應(yīng)變傳感基體,并沒有完全以柔性材料作為應(yīng)變傳感基體。
為解決上述問題,本文選取聚二甲基硅氧烷為實(shí)驗(yàn)基體,植入FBG陣列,研究了基于雙層正交FBG的可實(shí)現(xiàn)三維形狀重建的柔性形狀傳感器,并開展了實(shí)驗(yàn)測試,傳感器可有效測量三維形狀。
FBG柔性傳感器以聚二甲基硅氧烷(Polydimethylsiloxane,PDMS)作為襯底。PD?MS具備良好的光學(xué)性能和重復(fù)性,在清晰展現(xiàn)內(nèi)部陣列FBG的同時(shí),能在彈性變形內(nèi)發(fā)生多次重復(fù)變形而不影響其力學(xué)性能。前期研究表明[26],過高的PDMS配比使得制作的軟體基體硬度過高、脆性過大,測量時(shí)重復(fù)性低;過低的PD?MS配比使得制作的軟體基體表面有黏稠感,不利于開展測試。因此,本文選取了測量響應(yīng)較好,固化劑和液態(tài)PDMS配比為1∶5(應(yīng)變傳遞率為0.64)的PDMS作為承載FBG的基體,并將FBG植入軟體基體中。
圖1所示為FBG柔性形狀傳感器的三維模型。傳感器的尺寸為80 mm(長)×80 mm(寬)×3 mm(厚)。其中,所選用的FBG帶寬均為0.2 nm,反射率均為90%。此外,上層和下層均陣列植入4根光纖,相鄰光纖之間的距離為20 mm,每根光纖上等間距設(shè)置有4個(gè)FBG,相鄰FBG之間的距離均為20 mm。上層光纖纖芯距離柔性基體中性層的距離為1.125 mm,下層光纖纖芯距離柔性基體中性層的距離為0.625 mm。上、下層陣列植入的光纖編號以及FBG中心波長的初始值如表1所示。
表1 上、下層陣列植入的光纖編號以及FBG中心波長初始值Tab.1 Numbers of fiber implanted in upper and lower arrays and initial value of FBG center wavelength (mm)
圖1 基于光纖光柵的柔性機(jī)器人的形狀傳感器及其三維模型Fig.1 Shape sensor and 3D model of flexible robot based on FBG
圖2為FBG結(jié)構(gòu)和敏感原理示意圖。FBG是由于光纖的光敏性產(chǎn)生折射率的改動(dòng),將光敏光纖暴露在紫外光束互相干涉帶來的光波條紋里,形成折射率調(diào)制分布。根據(jù)光纖光柵的耦合模理論,F(xiàn)BG的光柵方程為:
圖2 光纖光柵結(jié)構(gòu)及其敏感原理示意圖Fig.2 Schematic diagram of structure and sensing princi?ple for FBG
式中:λB為FBG的中心波長,neff為光纖的有效折射率,Λ為柵格周期。
軸向應(yīng)變和溫度是影響FBG波長漂移的最直接因素。因此,F(xiàn)BG波長變化量與溫度和應(yīng)變的關(guān)系可以表示為:
式中:λB為FBG的初始波長,ΔλB為波長變化量,αf為光纖的熱膨脹系數(shù),ξ為光纖材料的熱光系數(shù),Pe為光纖的彈光系數(shù)(常溫時(shí)約等于0.22)。
曲率測量是基于柔性基體自身產(chǎn)生彎曲形變時(shí)基體內(nèi)部的FBG被動(dòng)地發(fā)生彎曲變形,引起FBG波長變化,從而得到彎曲應(yīng)變。變形曲率測量原理是基于純彎曲模型,每一個(gè)單獨(dú)的FBG可視為一個(gè)曲率傳感器。圖3所示為FBG在傳感器中的布置示意圖。
當(dāng)傳感器處于自然狀態(tài)時(shí),如圖3(a)所示,F(xiàn)BG受到的應(yīng)變?yōu)?。當(dāng)傳感器處于彎曲狀態(tài)時(shí),如圖3(b)所示,根據(jù)材料力學(xué)可知,中性層下方被拉伸,中性層上方被壓縮,而中性層無應(yīng)變。傳感器處于自由狀態(tài)時(shí),中性層長度與FBG的有效測量長度相等,設(shè)傳感器的中性層長度ab為L,傳感器彎曲狀態(tài)時(shí)FBG的有效長度為L cd,F(xiàn)BG距離中性層的距離bd為h,中性層的曲率半徑ob為ρ,傳感部位對應(yīng)的圓心角為θc,可得:
圖3 傳感器中FBG的布置示意圖Fig.3 Schematic diagram of FBG arrangement in the sensor
式中:ε為傳感部位的軸向應(yīng)變,K為曲率。由式(3)~式(7)可得:
在恒定溫度條件下,結(jié)合式(2)和式(8)可得曲率K與FBG波長變化量ΔλB的關(guān)系式為:
由式(9)可知,當(dāng)FBG確定的情況下,λB,Pe以及h均為常數(shù),曲率K與FBG波長變化量ΔλB呈線性關(guān)系。
曲面重建原則為基于空間離散點(diǎn)的曲面重構(gòu)。通過對波長漂移信息進(jìn)行曲率反演,融合多個(gè)光柵測點(diǎn)的曲率信息,得到各個(gè)測量點(diǎn)的空間坐標(biāo),再用MATLAB對空間離散點(diǎn)的插值擬合來重建三維形狀。
圓心角θ和弧長L的關(guān)系式為:
式中r為曲率半徑,值為1/K。
將r=1/K代入式(10)可得圓心角θ與曲率K的關(guān)系式為:
以一根光纖為例來求解單根光纖上4個(gè)FBG傳感點(diǎn)的空間坐標(biāo)。為符合傳感器中光纖多種彎曲形式,建立坐標(biāo)系以及光纖模擬彎曲曲線如圖4所示。圖4中所有變量命名如表2所示。
表2 圖4中所有變量命名Tab.2 Definition of all variables in Figure 4
圖4 光纖模擬彎曲曲線示意圖Fig.4 Schematic diagram of optical fiber simulated bend?ing curve
假設(shè)每個(gè)FBG在長度范圍內(nèi)發(fā)生等曲率彎曲變化。當(dāng)光纖發(fā)生彎曲變形時(shí),可認(rèn)為弧OA為FBG1測量長度;弧AB為FBG2測量長度;弧BC為FBG3測量長度;弧CD為FBG4測量長度。為 方 便 計(jì) 算,F(xiàn)BG1,F(xiàn)BG2,F(xiàn)BG3以 及FBG4的傳感點(diǎn)分別定義為A,B,C和D,易知OA與AB,AB與BC,BC與CD均相切,所以曲率半徑在該點(diǎn)均在同一直線上。根據(jù)數(shù)學(xué)函數(shù)關(guān)系分別求出A在坐標(biāo)系XOZ中的坐標(biāo)、B在坐標(biāo)系X AAZA中的坐標(biāo)、C在坐標(biāo)系XBBZB中的坐標(biāo)以及D在坐標(biāo)系X CCZC中的坐標(biāo)。再通過坐標(biāo)系的平移和旋轉(zhuǎn),求出A,B,C,D在坐標(biāo)系XOZ中的坐標(biāo)。
經(jīng)計(jì)算得A點(diǎn)坐標(biāo):
B點(diǎn)坐標(biāo):C點(diǎn)坐標(biāo):
D點(diǎn)坐標(biāo):
其余7根光纖的曲線情況可由相似的數(shù)學(xué)函數(shù)關(guān)系推導(dǎo),所有測量點(diǎn)的空間坐標(biāo)可以被獲得并用MATLAB對空間離散點(diǎn)的插值擬合來重建三維形狀。
圖5所示為柔性形狀傳感器及曲率標(biāo)定實(shí)驗(yàn)設(shè)備。其中FBG波長解調(diào)器為自主研發(fā),帶寬為1 525~1 605 nm,波長解調(diào)精度為3 pm,用于實(shí)時(shí)記錄測試時(shí)傳感器中FBG的波長變化情況。測試時(shí),為剔除環(huán)境溫度變化對彎曲測試中FBG波長漂移帶來的交叉耦合影響,實(shí)驗(yàn)室溫度恒定在25℃。
圖5 柔性形狀傳感器及曲率標(biāo)定實(shí)驗(yàn)設(shè)備Fig.5 Flexible shape sensor and curvature calibration ex?perimental equipment
將柔性傳感器平整無彎曲置于實(shí)驗(yàn)臺上,并連接FBG解調(diào)儀來實(shí)時(shí)記錄波長數(shù)據(jù)。對曲率分別為14.29,15.38,16.67,18.18,20,22.22和25 m-17個(gè)純彎曲模型進(jìn)行正彎曲標(biāo)定測試。在對每個(gè)標(biāo)定模型進(jìn)行彎曲測試時(shí),傳感器應(yīng)保持30 min左右,待FBG波長穩(wěn)定后記錄變化量,再將柔性傳感器平整還原放置在實(shí)驗(yàn)臺上,停止保存數(shù)據(jù)。待到FBG波長穩(wěn)定到初始值時(shí),對下一個(gè)標(biāo)定模型進(jìn)行標(biāo)定測試。
通過讀取FBG波長漂移量穩(wěn)定后的值,得到柔性形狀傳感器對不同曲率的應(yīng)變響應(yīng)情況,如圖6所示??梢缘玫剑嵝孕螤顐鞲衅髟谶M(jìn)行曲率測試時(shí),隨著曲率的增大,柔性傳感器植入的32個(gè)FBG的波長漂移量均呈線性遞增趨勢;而且,在測量同一個(gè)標(biāo)準(zhǔn)彎曲曲率標(biāo)定塊時(shí),上層FBG陣列和下層FBG陣列的波長漂移量均保持良好的一致性,說明同楊氏模量下應(yīng)變傳遞的穩(wěn)定性。
圖6 柔性形狀傳感器對不同曲率的應(yīng)變響應(yīng)Fig.6 Strain response of flexible shape sensor to different curvatures
為了更直觀反應(yīng)柔性形狀傳感器對彎曲曲率的靈敏度響應(yīng),對上層FBG陣列和下層FBG陣列的波長漂移量進(jìn)行算術(shù)平均,然后進(jìn)行線性擬合,即可得到柔性形狀傳感器對彎曲曲率的靈敏度響應(yīng),如圖7所示。由擬合函數(shù)可得,上層FBG陣列的靈敏度約為57.641 pm/m-1,下層FBG陣列的靈敏度約為32.250 pm/m-1,柔性形狀傳感器耦合穩(wěn)定后的波長漂移量均表現(xiàn)為良好的線性度。由圖7中線性擬合后的局部放大視圖可知,在對上層FBG陣列進(jìn)行正彎曲的曲率標(biāo)定時(shí),下層FBG陣列的波長變化量基本為0;在對下層FBG陣列行正彎曲的曲率標(biāo)定時(shí),上層FBG陣列的波長變化量基本為0,說明了FBG傳感器在不受溫度影響的前提下,只對軸向應(yīng)變敏感,對縱向應(yīng)變不敏感。
圖7 柔性形狀傳感器對彎曲曲率的靈敏度響應(yīng)Fig.7 Sensitivity response of flexible shape sensor to bending curvatures
為更加全面地研究柔性形狀傳感器對三維曲面的應(yīng)變響應(yīng)情況,采用Solid Works設(shè)計(jì)并3D打印了3個(gè)不同形狀的測試基體,表面形狀分別為等曲率曲面、波浪狀曲面以及鼠標(biāo)狀曲面,在溫度為25℃條件下進(jìn)行測試。先將柔性傳感器平整無彎曲變形置于實(shí)驗(yàn)臺上,并接入FBG解調(diào)儀,實(shí)時(shí)保存波長數(shù)據(jù)。再將柔性傳感器置于測試基體表面,緊接著用與測試基體相同尺寸的模型緩慢置于傳感器上方以確保傳感器與測試基體表面完整貼合。根據(jù)前期測試經(jīng)驗(yàn),保持30 min以上,待FBG波長完全穩(wěn)定之后讀取每個(gè)感測點(diǎn)的波長漂移值。將得到的32個(gè)FBG測點(diǎn)的波長漂移值代入理論推導(dǎo)公式轉(zhuǎn)化為各測點(diǎn)的曲率信息,將曲率信息轉(zhuǎn)化為各個(gè)測量點(diǎn)的空間坐標(biāo),再用MATLAB對空間離散坐標(biāo)點(diǎn)的插值擬合來重建測試基體的表面形狀。對其他兩個(gè)測試基體同樣采用上述步驟,測量結(jié)果如圖8所示。由圖可知,實(shí)驗(yàn)得到的圖形與測試基體的表面形狀基本保持一致,說明該柔性傳感器能夠感知被測物體表面的三維形狀。
圖8 測試曲面及三維重構(gòu)圖形等曲率曲面的三維重構(gòu)Fig.8 Test surfaces and 3D reconstruction graphics of constant curvature surfaces
為得到柔性傳感器的測量精度,將32個(gè)FBG測點(diǎn)的曲率代入誤差計(jì)算公式ε=其中Pa為測試基體表面的實(shí)際曲率,Pe為柔性傳感器實(shí)驗(yàn)測得的曲率。最大曲率的測量誤差為4.5%,最小曲率的測量誤差為2.8%,由此說明了該柔性傳感器在進(jìn)行形狀測量時(shí)對測量點(diǎn)曲率感知的高精度性。
由圖8中重構(gòu)后的曲面可以看出,除了測量點(diǎn)之外,重建曲面的其他部分相對于被測基體仍然有不平整的部位,說明該方法只能還原被測基體表面的大致輪廓,并不能高精度地還原出被測基體的三維形狀。分析認(rèn)為誤差來源主要有如下三個(gè)方面:
(1)重建算法誤差。在本文推導(dǎo)的三維重建算法中,將植入的單個(gè)FBG當(dāng)作是一個(gè)傳感點(diǎn),理論認(rèn)為在有效的FBG檢測區(qū)域內(nèi)發(fā)生等曲率彎曲變形,而實(shí)際的FBG具有一定長度,實(shí)際情況中很難時(shí)刻滿足FBG在檢測區(qū)域內(nèi)發(fā)生等曲率彎曲變形,必定會帶來誤差。該誤差是系統(tǒng)誤差,只能減小,不能消除;
(2)溫度交叉敏感誤差。雖然在室溫恒定條件下進(jìn)行測試,但傳感器實(shí)驗(yàn)操作中,難免受到人手的觸碰而帶來局部溫度變化;
(3)FBG布設(shè)誤差。多個(gè)FBG雙層陣列的布置中難免會存在工藝誤差。
本文提出了一種基于雙層正交FBG的可實(shí)現(xiàn)三維形狀測量的柔性傳感器。該傳感器以PDMS為基體,上層和下層分別植入16個(gè)FBG陣列,構(gòu)成32個(gè)FBG傳感監(jiān)測點(diǎn)。在室溫下對該柔性傳感器進(jìn)行了曲率標(biāo)定測試,得到了光纖光柵波長漂移量與曲率之間的線性遞增關(guān)系。接著對柔性傳感器進(jìn)行了三維形狀重建測試,將測量點(diǎn)光纖光柵波長漂移值轉(zhuǎn)化為曲率值,再將曲率值轉(zhuǎn)化為三維空間坐標(biāo)值,最后通過對空間離散點(diǎn)的插值擬合,可視化地重建了測試基體表面的三維形狀。結(jié)果表明:該柔性形狀傳感器可以實(shí)現(xiàn)對復(fù)雜曲面的三維形狀感知,最大曲率測量誤差為4.5%,可為軟體機(jī)器人形狀測量提供技術(shù)支持。后期將繼續(xù)優(yōu)化重建算法、結(jié)構(gòu)以及FBG布設(shè)方式,探索軟體機(jī)器人高精度形狀測量的可行技術(shù)。