杜妍辰,林俊文,周 琦
(1.上海理工大學(xué)康復(fù)工程與技術(shù)研究所;2.上??祻?fù)器械工程技術(shù)研究中心;3.民政部神經(jīng)功能信息與康復(fù)工程重點實驗室,上海 200093)
日益嚴(yán)重的人口老齡化以及因疾病致使肢體殘障,我國下肢功能障礙患者逐年遞增[1]。對患者來說,既有輪椅等輔助移動設(shè)備需求,也有幫助下肢訓(xùn)練康復(fù)設(shè)備的需求,而需求設(shè)備間的移動和穿戴給患者帶來許多阻礙。因此,集康復(fù)訓(xùn)練功能和移動功能于一體的輪椅系統(tǒng)越來越多。
我國針對輪椅車出臺了GB/ T 18029 系列國家標(biāo)準(zhǔn),對輪椅車產(chǎn)品進(jìn)入市場前進(jìn)行測試,相對應(yīng)的國際標(biāo)準(zhǔn)為ISO 7176 系列。針對輪椅靜態(tài)強(qiáng)度性能,俞顯佳等[2]提出一種輪椅靜態(tài)強(qiáng)度測試系統(tǒng),可對扶手、腳踏、手把同時測試,并用數(shù)控比例閥和高精度力傳感器與放大器配合實現(xiàn)高精度力值抓取,但施加載荷未考慮人體乘坐時的生理工況;針對輪椅動態(tài)強(qiáng)度性能,王志明等[3]提出一種輪椅車動態(tài)測試系統(tǒng),可對前后輪間距為350~1 500mm 輪椅車進(jìn)行顛簸測試和0~40°爬坡測試,并可切換電動或手推式測試模式,但其測試未考慮輪椅的負(fù)載情況;針對輪椅腳輪疲勞度性能,美國匹茲堡大學(xué)Jonathan 等[4]研究了新型路況模擬腳輪測試系統(tǒng),通過與頂置電機(jī)配合旋轉(zhuǎn)的盤面模擬測試接觸平面,通過在盤面上裝載如砂礫、泥水、黏土等,模擬不同道路表面材質(zhì)情況,但其測試未考慮乘員操作對腳輪的磨損增值。
綜合分析現(xiàn)有針對輪椅的測試設(shè)備后發(fā)現(xiàn),目前未有相關(guān)設(shè)備對帶下肢康復(fù)功能輪椅的康復(fù)性能進(jìn)行測試評定,且對輪椅的測試設(shè)備大多未考慮乘員質(zhì)量、生理特征和主動操作等影響。由于國內(nèi)尚未出臺輪椅車中下肢康復(fù)訓(xùn)練部分國家標(biāo)準(zhǔn),本文參考GB 24436-2009、GB/T 28919-2012 及ISO 7176 系列,提出一種針對下肢康復(fù)訓(xùn)練模塊的測試平臺,模擬人體質(zhì)量、人體生理特征及主動運動等特點,完成對下肢訓(xùn)練、平衡訓(xùn)練和痙攣保護(hù)等功能的安全性測試。
該測試平臺由測試假人主體與外掛架兩部分組成,如圖1 所示。其中假人主體按照人體結(jié)構(gòu)分為足部、小腿、大腿和軀干4 個部分,如圖2 所示。假人尺寸、質(zhì)量及質(zhì)心與人體生理特征相同,下肢訓(xùn)練的平穩(wěn)性由髖、膝關(guān)節(jié)處安裝的角度及扭矩傳感器采集數(shù)值進(jìn)行分析測試。平衡訓(xùn)練安全性由足底壓力傳感器、整機(jī)雙平行四邊形設(shè)計、軀干內(nèi)絲桿電機(jī)與外掛架組成機(jī)械結(jié)構(gòu),通過被限制的平面內(nèi)主動傾斜運動完成測試。痙攣保護(hù)安全性由膝關(guān)節(jié)中的摩擦盤和大腿中部的氣動夾鉗提供可調(diào)制動力組成的可調(diào)阻力模塊完成。
控制系統(tǒng)主要由STM32F429IGT 核心控制模塊、通訊模塊、步進(jìn)電機(jī)驅(qū)動模塊、傳感器信號多通道變送模塊、抱閘控制模塊、電源模塊等組成,如圖3 所示。整個系統(tǒng)主要對核心動力源步進(jìn)電機(jī)進(jìn)行控制,實現(xiàn)機(jī)構(gòu)對人體傾斜時髖部運動模擬。另外,在左右髖部和膝部都安裝了角度傳感器和扭矩傳感器,在腳底安裝了壓力傳感器,能夠在整個機(jī)械運動時檢測髖部、膝部、腳部的相關(guān)參數(shù),并通過MUC 將初步的數(shù)據(jù)處理上傳至PC 端,進(jìn)行數(shù)據(jù)儲存和進(jìn)一步分析。
Fig.1 Test platform components圖1 測試平臺組成部分
Fig.2 Design of each part of dummy body圖2 假人主體各部設(shè)計
控制系統(tǒng)電路電源由外部開關(guān)電源模塊提供24V 直流電源,為滿足系統(tǒng)中各個模塊對于不同電壓的需求,采用逐級降壓方案,如圖4 所示。先采用LM2596 芯片將24V直流電壓轉(zhuǎn)化為12V,然后通過LM7805 芯片將12V 轉(zhuǎn)為5V 電壓,5V 直流電主要供傳感器使用。核心MUC 的供電為3.3V,由LM1117MPX-3.3芯片將5V 轉(zhuǎn)化為3.3V。
通訊模塊支持WiFi通訊和USB 通訊兩種模式。
本系統(tǒng)WiFi通訊使得該裝置具有遠(yuǎn)程無線控制功能,并且可以通過WiFi 將傳感器的實時數(shù)據(jù)傳輸至自建的數(shù)據(jù)庫,方便對數(shù)據(jù)進(jìn)行后期分析管理。
PC 端上位機(jī)通過USB 通訊對本裝置進(jìn)行運動控制及程序調(diào)試。USB 總線作為一種高速串行總線,其極高的傳輸速度可以滿足高速數(shù)據(jù)傳輸?shù)膽?yīng)用環(huán)境要求,支持即插即用和熱插拔,具有兼容性好的特點。
本模塊將傳感器的信號轉(zhuǎn)換為MUC 可識別的電壓信號,主要由一階RC 濾波電路、INA128 儀表放大器電路和二階SK 型低通濾波器電路組成,如圖5所示。
Fig.3 General design of control system圖3 控制系統(tǒng)總體設(shè)計
Fig.4 Power module circuit圖4 電源模塊電路
Fig.5 Circuit of transducer signal transmission module圖5 傳感器信號變送模塊電路
一階RC 濾波電路的作用是對傳感器的輸入信號進(jìn)行簡單的濾波處理,減少高頻噪聲。RC 濾波器電路的截止頻率公式如下:
當(dāng)R 為10KΩ,C 為100nF 時,截止頻率f 為159H,意味著低通濾波器只會對高于141Hz的信號起到抑制作用。
NA128 是低功耗通用儀器放大器,可提供很高的精度,多功能的三運放設(shè)計和小尺寸使其應(yīng)用廣泛。電流反饋輸入電路即使在高增益(G=100 時為200kHz)下也能提供寬帶寬。該放大電路的輸出電壓VO和輸入電壓VIN-、VIN+的關(guān)系如式(2)所示:
在INA128 的后級加上一個二階SK 型低通濾波器電路,對輸出信號進(jìn)行濾波以提高信號的穩(wěn)定性。濾波器電路的截止頻率公式如下:
多通道變送模塊對應(yīng)每一個傳感器都有一個相同信號的變送電路,而且每路信號放大的倍數(shù)可調(diào),可根據(jù)不同傳感器進(jìn)行調(diào)節(jié)。
抱閘控制模塊負(fù)責(zé)控制氣動剎車電磁閥的啟停功能,并由電磁閥門的開合控制氣動剎車進(jìn)行制動工作,實現(xiàn)痙攣狀態(tài)模擬。抱閘控制模塊由信號輸入、光耦芯片、MOS管開關(guān)和抱閘開關(guān)組成。如圖6 所示,BREAK LEFT CRL及BREAK RIGHT CRL 是由STM32 單片機(jī)發(fā)出的控制信號,傳遞至TLP521 光耦隔離器芯片定的電氣阻隔功能,可實現(xiàn)精準(zhǔn)的開垂直導(dǎo)電結(jié)構(gòu)帶來的耐壓和耐電流能力,光耦芯片即可控制MOS 管Q1 和Q2 通斷,以實現(xiàn)抱閘開關(guān)BREAK LEFT 和BREAK RIGHT 的開合,實現(xiàn)3.3V 開關(guān)控制24V 電路開關(guān)的功能。
本裝置使用一個兩相四線步進(jìn)電機(jī),需要對電機(jī)調(diào)速、正反轉(zhuǎn)以及位置控制。直接用高低電平方式驅(qū)動兩相四線電機(jī)有四拍、八拍方式,對應(yīng)細(xì)分為滿步、半步。本文選擇滿步細(xì)分、四拍方式驅(qū)動,具體驅(qū)動時序如表1
Fig.6 Circuit of switch control module圖6 抱閘控制模塊電路
Table 1 Driver chronology表1 驅(qū)動時序
DRV8874是一款集成電機(jī)驅(qū)動器,具有N 通道H 橋、電荷泵、電流傳感和比例輸出、電流調(diào)節(jié)和保護(hù)電路。電荷泵通過支持N 溝道MOSFET 半橋和100%占空比驅(qū)動來提高效率。這一系列設(shè)備采用針對針RDS(on)變體,以最小的設(shè)計變化來支持不同的負(fù)載。采用兩塊DRV8874 芯片組成兩相四線步進(jìn)電機(jī)電路,如圖7所示。
Fig.7 Motor drive circuit圖7 電機(jī)驅(qū)動電路
為實現(xiàn)電機(jī)調(diào)速,采用單極性正弦脈沖寬度調(diào)制(SPWM)調(diào)速,如圖8 所示。在PWM 基礎(chǔ)上改變調(diào)制脈沖方式,脈沖寬度時間占空比按正弦規(guī)律排列,輸出的波形經(jīng)過適當(dāng)?shù)臑V波可以做到正弦波輸出。SPWM 具有開關(guān)損耗低、效率高、輸出波形良好的優(yōu)點。
使用STM32F429IGT 的高級定時器可以輸出PWM 波,設(shè)置PWM 波的頻率,根據(jù)定時器的輸出比較模式產(chǎn)生PWM 波的頻率計算公式如下:
其中,arr 為重裝載值,psc 為預(yù)分頻值。在成功設(shè)置PWM 基礎(chǔ)上,采用規(guī)則采樣法,通過控制計數(shù)比較模塊和輸出控制模塊可以輸出SPWM 波,如圖9所示。
Fig.8 SPWM pulse waveform圖8 SPWM脈沖波形
Fig.9 SPWM wave conversion process圖9 SPWM波轉(zhuǎn)換流程
因步進(jìn)電機(jī)轉(zhuǎn)速與步進(jìn)距離是根據(jù)電壓信號的大小控制的,因此通過改變SPWM 波的波形,可以達(dá)到控制電機(jī)轉(zhuǎn)速和行程的目的。本實驗通過示波器查看控制板輸出的SPWM 波形,判斷其是否滿足控制電機(jī)需求。由圖10可知,示波器顯示的SPWM 輸出波形與計算機(jī)模擬情況一致,通過改變SPWM 波脈沖寬度可有效地對電機(jī)進(jìn)行運動控制。由圖11 可知,在輸出端設(shè)置一個電容后,對輸出的波形進(jìn)行調(diào)制可得到單極性的正弦波。
本文基于Adams 軟件構(gòu)建假人三維測試模型,對由貫通式絲桿步進(jìn)電機(jī)驅(qū)動的傾斜運動進(jìn)行運動過程模擬,如圖12 所示。測試假人的傾斜運動功能由絲桿與電機(jī)組成的螺旋副實現(xiàn),相對貫通式絲桿步進(jìn)電機(jī)軸向移動速度為2 mm/s,根據(jù)絲桿電機(jī)選型,絲桿導(dǎo)程為4 mm,則步進(jìn)電機(jī)轉(zhuǎn)子旋轉(zhuǎn)360 °絲桿前進(jìn)4 mm。由傾斜角θ=20 °可知,對應(yīng)螺旋副旋轉(zhuǎn)角度為2 300 °,總運動時長25.56 s,因此設(shè)置驅(qū)動函數(shù)如下:
為求解測試假人傾斜過程中整體質(zhì)心投影地面變化情況,使用外部子程序標(biāo)記其整體質(zhì)心位置,再由求解文件繪制質(zhì)心在仿真運動過程中的參數(shù)數(shù)值變化。假人在傾斜運動過程中質(zhì)心投影于地面Y 軸隨時間變化的曲線如圖13 所示。由圖13 可知,質(zhì)心投影點變化距離范圍在0~135 mm 以內(nèi),因機(jī)構(gòu)整體運行平穩(wěn),其投影點位移曲線在整個變化周期內(nèi)的變化趨勢呈直線狀,機(jī)構(gòu)質(zhì)心移動過程平穩(wěn),滿足設(shè)計所需要求。
Fig.10 The oscilloscope outputs the SPWM waveform圖10 示波器輸出SPWM波形
Fig.11 Modulate unipolar sine waves圖11 調(diào)制單極性正弦波
Fig.12 Tilt simulation motion process圖12 傾斜仿真運動過程
Fig.13 Distance change curve of projection point of center of mass圖13 質(zhì)心投影點位移變化曲線
本文提出一種輪椅式下肢訓(xùn)練設(shè)備測試平臺控制系統(tǒng)設(shè)計,通過傳感器、制動器及驅(qū)動電機(jī)的配合,對相關(guān)設(shè)備的下肢訓(xùn)練、平衡訓(xùn)練及痙攣保護(hù)安全性進(jìn)行測試??刂葡到y(tǒng)中,由核心控制模塊STM32F429IGT 的高級定時器輸出PWM 波,通過控制計數(shù)比較模塊和輸出控制模塊得到SPWM 波,經(jīng)過計算機(jī)模擬和示波器輸出驗證,可更平穩(wěn)地控制電機(jī)運動。通過傳感器信號變送模塊及通訊模塊中的USB 及WiFi 通訊,將采集信息交由上位機(jī)處理,得到測試的實時數(shù)據(jù)。經(jīng)ADAMS 仿真軟件仿真,可知此測試平臺進(jìn)行主動測試時機(jī)構(gòu)運行平穩(wěn),滿足設(shè)計要求。但在真實人體傾斜過程中,因各類人群生理特征中質(zhì)量及力量不同,引起的轉(zhuǎn)動慣量及傾斜速度也不同,其運動控制需要模擬各類人群的運動特征。因此,后續(xù)研究應(yīng)通過優(yōu)化控制算法,增加系統(tǒng)反饋,以模擬不同人群的傾斜運動情況。