郭炳延
(中國礦業(yè)大學,江蘇 徐州 221116)
圖1 為測量系統(tǒng)硬件原理框圖。該測量系統(tǒng)主要由直流源、交流源、電阻應變傳感器、電容傳感器、NTC 熱敏電阻、FPGA、舵機和顯示裝置組成。電源輸出電流,經(jīng)傳感器測量電路后,將模擬信號輸入FPGA,通過FPGA 內(nèi)程序算法,進行高速信號處理,控制舵機轉(zhuǎn)向以及輸出顯示[1-2]。
圖1 系統(tǒng)硬件原理圖
1.1.1 裝置結(jié)構(gòu)
應變片的基底固定在仿生機器手的上下表面里(根據(jù)手指大小確定基底個數(shù)n1),一個基底上粘有4 個應變片,上面2 片,下面2 片,如圖2、圖3 所示。
1.1.2 測量轉(zhuǎn)換電路圖
將每個基底上的4 片應變片接成全橋差動等臂橋的形式。每個相對臂所接應變片為一組,當受外部力作用時,一組受壓一組受拉。應變片差動連接如圖4所示。
圖2 仿生機械手指骨側(cè)示圖
圖3 應變片粘貼俯視(仰視)圖
1.1.3 工作原理
電阻應變片是將被測量的力通過它產(chǎn)生的金屬彈性形變轉(zhuǎn)化為電阻值變化的敏感元件,測量時將應變片粘貼到彈性金屬的受力部位上,通過測量電路使輸出電壓與被測量的力成比例,從而實現(xiàn)對力的檢測。
設一根電阻絲未受力時原始電阻值為:
圖4 全橋差動連接圖
在外力F的作用下,電阻絲的ρ、l、S發(fā)生變化,引起電阻變化ΔR,相對變化為:
因為S=π·r2,則截面積ΔS=2πrΔr,相對變化為:
將式(3)代入式(2)可得:
因為半導體應變電阻溫度系數(shù)較大,非線性嚴重,故采用金屬應變電阻。由于Δρ/ρ很小,可以忽略。根據(jù)應力與應變的關(guān)系:σ=Eε,進一步推出電阻變化率與應力關(guān)系:
在外力的作用下,應變片的電阻發(fā)生了變化,破壞了電橋的平衡。若R1、R2、R3、R4分別產(chǎn)生ΔR1、ΔR2、ΔR3、ΔR4的電阻變化。由于滿足R1=R2=R3=R4(等臂橋),且ΔR1=-ΔR2=-ΔR3=R4,則電橋輸出電壓U0為:
由此推出應力與輸出電壓的關(guān)系方程,實現(xiàn)了對力的檢測。此外,電壓靈敏度KU為:
根據(jù)如上公式推導,可以看出測量結(jié)果沒有非線性誤差,并且電壓靈敏度較高,由輸入電壓U決定。此外,通過線路補償?shù)姆椒ǎ擅钕藴囟人鸬南到y(tǒng)誤差,其中R2、R3為補償電阻。
1.1.4 工作過程
直流源接入后,測力傳感器輸出連續(xù)的模擬信號,F(xiàn)PGA 進行高速的AD 轉(zhuǎn)換,并通過算法控制舵機與終端顯示,從而實現(xiàn)對機器手表面所受力的檢測與控制。
1.2.1 裝置結(jié)構(gòu)
圖5 為關(guān)節(jié)主視圖,3 個半圓極板和舵機裝在關(guān)節(jié)中,左右半圓極板相對面積為0,舵機軸旋轉(zhuǎn)帶動中間半圓極板和上一級指骨,從而可以測量關(guān)節(jié)的角位移。
圖5 仿生機器手關(guān)節(jié)主視圖
1.2.2 測量轉(zhuǎn)換電路圖
當左極板與中間極板相對面積變化ΔS時,右極板與中間極板相對面積變化-ΔS,由可知ΔCx=-ΔC3,即Cx與C3為差動電容。
設C1=C2=Cx=C3=C,電橋平衡,輸出U0=0,差動交流等臂電橋連接圖如圖6 所示。
圖6 差動交流電橋連接圖
1.2.3 工作原理
這里角度傳感器為變面積型電容傳感器,是將被測量的角位移通過極板相對面積的改變轉(zhuǎn)化為電容變化。測量時固定一個半圓極板,將另一半圓極板與旋轉(zhuǎn)軸相連,通過測量電路使電容的變化與被測量的角位移成正比,從而實現(xiàn)對力的測量。
在舵機作用下,極板間電容發(fā)生變化,破壞了電橋的平衡。若電容Cx產(chǎn)生ΔC的變化,則電容C3產(chǎn)生-ΔC的變化,此時電橋輸出電壓U0為:
由此實現(xiàn)了對機器手關(guān)節(jié)角位移的檢測。此外,電壓靈敏度KU為:
根據(jù)如上公式推導,可以看出測量結(jié)果沒有非線性誤差,并且電壓靈敏度較高。
1.2.4 工作過程
交流電源接入后,角度傳感器輸出連續(xù)變化的交流信號,F(xiàn)PGA 進行高速的AD 轉(zhuǎn)換,并通過算法控制舵機與終端顯示,從而實現(xiàn)對機器手關(guān)節(jié)角位移的檢測與控制。
1.3.1 裝置結(jié)構(gòu)
圖2 為仿生機械手指骨側(cè)示圖,NTC 熱敏電阻位于兩個基底之間,緊貼在內(nèi)部防護皮上,使外部熱量可以快速傳遞到熱敏電阻中,從而實時準確反應外部溫度。
1.3.2 測量轉(zhuǎn)換電路圖
利用一般線路補償法測量NTC熱敏電阻的阻值(溫度越高,電阻越?。?。
設R1=R2=R3=R4,電橋平衡,輸出U0=0,圖7 為連接圖。
圖7 一般線路補償連接圖
1.3.3 工作原理
NTC 熱敏電阻具有很高的負溫度系數(shù),即溫度越高,阻值越小,且具有明顯的非線性。測量時將NTC熱敏電阻粘貼到仿生機器手的表面里,通過測量電路使輸出電壓與被測溫度成比例關(guān)系,從而實現(xiàn)對溫度的檢測。
外部溫度改變時,NTC 熱敏電阻阻值改變,電橋平衡被破壞。由電路圖可列方程:
因為NTC 熱敏電阻阻值與溫度呈非線性,所以可以通過查表的方式獲得輸出電壓對應的電阻值所代表的溫度,由此實現(xiàn)了對機器手表面溫度的檢測。此外,電壓靈敏度KU為:
可以增大R1以減小非線性誤差。
1.3.4 工作過程
直流源接入后,溫度傳感器輸出連續(xù)變化的模擬信號,F(xiàn)PGA 進行高速的AD 轉(zhuǎn)換,并通過算法控制舵機與終端顯示,從而實現(xiàn)對機器手表面溫度的檢測與控制。
FPGA 相比于MCU 和DSP 具有高速信號處理、AD 采樣率高和更大的并行度等優(yōu)點,更符合本系統(tǒng)所要求的快速、穩(wěn)定、準確等高性能。
FPGA 上采用低電壓差分信令(LVDS)輸入,僅需一個電阻器和一個電容器就能實現(xiàn)模擬輸入信號的數(shù)字化。由于數(shù)百組LVDS 輸入駐留在生成電流的FPGA 器件上,因此可通過單個FPGA 芯片實現(xiàn)數(shù)百模擬信號的數(shù)字化,大大簡化外圍電路的搭建,實用性高。
在現(xiàn)實測試的過程中,數(shù)據(jù)中含有各種誤差,產(chǎn)生的原因可能是線路間信號的干擾或是機器抖動帶來的噪聲。為了獲得最可信賴的測量結(jié)果,采用最小二乘法擬合數(shù)據(jù)曲線,使各測量值的殘差平方和最小,從而提高測量數(shù)據(jù)的準確性與可信性。
應用電阻應變傳感器測量仿生機器手所受的壓力,應用電容傳感器測量仿生機器手關(guān)節(jié)的角位移,應用NTC 熱敏電阻傳感器測量仿生機器手表面的溫度,利用FPGA 對測量數(shù)據(jù)進行處理,可以有效地監(jiān)測機器手工作狀態(tài),為其安全穩(wěn)定運行起著必不可少的作用。本系統(tǒng)也可以經(jīng)改進后移植到其他物聯(lián)網(wǎng)領(lǐng)域。