[go: up one dir, main page]

TWI901483B - Upper limb exoskeleton device with safe operation function - Google Patents

Upper limb exoskeleton device with safe operation function

Info

Publication number
TWI901483B
TWI901483B TW113149645A TW113149645A TWI901483B TW I901483 B TWI901483 B TW I901483B TW 113149645 A TW113149645 A TW 113149645A TW 113149645 A TW113149645 A TW 113149645A TW I901483 B TWI901483 B TW I901483B
Authority
TW
Taiwan
Prior art keywords
upper limb
limb exoskeleton
exoskeleton device
safe operation
operation function
Prior art date
Application number
TW113149645A
Other languages
Chinese (zh)
Inventor
任國光
謝叔達
吳尚儒
徐愷辰
楊晉淯
陳柏廷
李聯旺
Original Assignee
國家中山科學研究院
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 國家中山科學研究院 filed Critical 國家中山科學研究院
Priority to TW113149645A priority Critical patent/TWI901483B/en
Application granted granted Critical
Publication of TWI901483B publication Critical patent/TWI901483B/en

Links

Landscapes

  • Prostheses (AREA)

Abstract

本發明係為一種具安全操作功能之上肢外骨骼裝置,係包括:係包括:一本體,其具有一背部結構與二手部結構,該二手部結構分別具有一肩關節單元與一肘關節單元,該肩關節單元;二角度感測器,係分別設置於該肩關節單元,用於感測該肩關節單元之旋轉角度;二驅動馬達,係設置於該背部結構上,分別透過二串聯彈性致動器與二驅動線連接至該二手部結構,並驅動該二手部結構之肩關節單元旋轉;一電源單元,係供應該上肢外骨骼裝置之各元件運作所需之電力;一操控介面,係由該使用者穿戴,用於發送控制命令;一主控制器單元,係設置於該背部結構上,係接收該角度感測器之旋轉角度訊號與該控制命令,用以控制該驅動馬達。 The present invention is an upper limb exoskeleton device with a safe operation function, comprising: a main body having a back structure and a second hand structure, wherein the second hand structure has a shoulder joint unit and an elbow joint unit respectively; the shoulder joint unit; two angle sensors, respectively disposed on the shoulder joint unit, for sensing the rotation angle of the shoulder joint unit; two drive motors, respectively disposed on the back structure, through two series of A flexible actuator and two drive lines are connected to the second hand structure, driving the shoulder joint unit of the second hand structure to rotate. A power supply unit supplies the power required for the operation of various components of the upper limb exoskeleton device. A control interface, worn by the user, is used to send control commands. A main controller unit, located on the back structure, receives the rotation angle signal from the angle sensor and the control command to control the drive motor.

Description

具安全操作功能之上肢外骨骼裝置 Upper limb exoskeleton device with safe operation function

本發明係與穿戴式外骨骼技術有關,特別係指一種可在提供助力與具備順應性(安全性)的同時,改善主動式上肢外骨骼安全性與系統能源使用效率之具安全操作功能之上肢外骨骼裝置。 This invention relates to wearable exoskeleton technology, and in particular to an upper limb exoskeleton device with safe operation capabilities that can improve the safety and energy efficiency of active upper limb exoskeletons while providing assistance and compliance (safety).

上肢外骨骼裝置主要包括被動式和主動式兩大類:被動式上肢外骨骼利用彈簧等蓄能元件提供被動助力,普遍相較主動上肢外骨骼而言、能提供的輔助扭力較小,但成本較低;主動式上肢外骨骼透過高功率密度的馬達/致動器提供助力,針對不同應用情境可透過軟體演算法切換不同模式,使外骨骼可適用更多元工作環境的機會。但使用時間可能因電池電量而受限,且較少有安全控制之軟體設計發明。 Upper-limb exoskeletons are primarily classified into two types: passive and active. Passive upper-limb exoskeletons utilize energy storage elements such as springs to provide passive assistance. Compared to active upper-limb exoskeletons, they generally provide less assistive torque but are less expensive. Active upper-limb exoskeletons utilize high-power density motors/actuators for assistance. Software algorithms can switch between different modes for different application scenarios, allowing the exoskeleton to adapt to a wider range of work environments. However, battery life may limit their operating time, and there are fewer software-based safety controls.

現有先前技術均未提及如何設計出同時兼顧助力、順應性(舒適性)與安全性的上肢外骨骼裝置,亦未提及主動上肢外骨骼如何解決雙手因系統故障誤作動,被外骨骼束縛而產生的安全性與使用時間受電源限制的問題。 Existing technologies have not addressed how to design an upper-limb exoskeleton device that simultaneously balances assistance, compliance (comfort), and safety. Furthermore, they have not addressed how active upper-limb exoskeletons can address safety concerns and power-limited usage time caused by the hands being restrained by the exoskeleton due to system failures.

為改善先前技術之缺點,本發明係提供一種具安 全操作功能之上肢外骨骼裝置,可在提供助力與具備順應性(安全性)的同時,改善主動式上肢外骨骼安全性與系統能源使用效率。 To address the shortcomings of prior art, the present invention provides an upper limb exoskeleton device with safe operation capabilities. This device can provide assistance and compliance (safety) while improving the safety and energy efficiency of active upper limb exoskeletons.

本發明係為一種具安全操作功能之上肢外骨骼裝置,係包括:一本體,係穿戴於一使用者上半身,其具有一背部結構與二手部結構,該二手部結構分別設置於該背部結構兩側,該二手部結構分別具有一肩關節單元與一肘關節單元;二角度感測器,係分別設置於該肩關節單元,用於感測該肩關節單元之旋轉角度;二驅動馬達,係設置於該背部結構上,分別透過二串聯彈性致動器與二驅動線連接至該二手部結構,並驅動該二手部結構之肩關節單元旋轉;一電源單元,係供應該上肢外骨骼裝置之各元件運作所需之電力;一操控介面,係由該使用者穿戴,用於發送控制命令;一主控制器單元,係設置於該背部結構上,係接收該角度感測器之旋轉角度訊號與該控制命令,用以控制該驅動馬達;其中該主控制器係根據一導納模型即時調整該上肢外骨骼裝置之系統剛度與阻尼參數,降低使用者因元件故障而受傷之風險。 The present invention is an upper limb exoskeleton device with a safe operation function, comprising: a main body, which is worn on the upper body of a user, and has a back structure and a second hand structure, the second hand structure being respectively arranged on both sides of the back structure, and the second hand structure having a shoulder joint unit and an elbow joint unit; two angle sensors, which are respectively arranged on the shoulder joint unit, for sensing the rotation angle of the shoulder joint unit; two drive motors, which are arranged on the back structure, and are respectively connected to the second hand structure through two series elastic actuators and two drive lines. The upper limb exoskeleton comprises a rotational mechanism and drives the shoulder joint unit of the second hand structure to rotate; a power unit supplies the power required for the operation of various components of the upper limb exoskeleton device; a control interface, worn by the user, is used to send control commands; a main controller unit, located on the back structure, receives the rotation angle signal from the angle sensor and the control command to control the drive motor; the main controller adjusts the system stiffness and damping parameters of the upper limb exoskeleton device in real time based on an admittance model to reduce the risk of injury to the user due to component failure.

本發明之一實施例中,該驅動馬達係為直流無刷馬達(Brushless DC Motor,BLDC)。 In one embodiment of the present invention, the drive motor is a brushless DC motor (BLDC).

本發明之一實施例中,該二手部結構與該背部結構連結處,或該肩關節單元處可額外設置一至多個自由度單元,如軸承、關節等。 In one embodiment of the present invention, one or more additional degree-of-freedom units, such as bearings, joints, etc., may be provided at the connection between the second hand structure and the back structure, or at the shoulder joint unit.

本發明之一實施例中,該肘關節單元係設置有一扭力彈簧。 In one embodiment of the present invention, the elbow joint unit is provided with a torsion spring.

本發明之一實施例中,該驅動馬達與該串聯彈性致動器間係具有棘爪與棘輪,用於鎖定或解鎖該驅動馬達之驅動線。 In one embodiment of the present invention, a pawl and a ratchet are provided between the drive motor and the series elastic actuator to lock or unlock the drive wire of the drive motor.

本發明之一實施例中,該操控介面係為一觸控式控制器,使用觸控螢幕或控制按鈕。 In one embodiment of the present invention, the control interface is a touch controller using a touch screen or control buttons.

本發明之一實施例中,該操控介面係為一語音式控制器,用於接收該使用者之語音命令。 In one embodiment of the present invention, the control interface is a voice controller for receiving voice commands from the user.

本發明之一實施例中,該操控介面與該主控制器單元間係以藍牙(Bluetooth)或其他無線傳輸方式傳輸資訊。 In one embodiment of the present invention, information is transmitted between the control interface and the main controller unit via Bluetooth or other wireless transmission methods.

本發明之一實施例中,該驅動線係為繩索、鍊條、皮帶或其他種類之柔性傳動裝置。 In one embodiment of the present invention, the drive line is a rope, chain, belt or other type of flexible transmission device.

本發明之一實施例中,該主控制器單元係以CAN bus與該角度感測器、該驅動馬達通訊並加以控制。 In one embodiment of the present invention, the main controller unit communicates with and controls the angle sensor and the drive motor via the CAN bus.

以上之概述與接下來的詳細說明及附圖,皆是為了能進一步說明本發明達到預定目的所採取的方式、手段及功效。而有關本發明的其他目的及優點,將在後續的說明及圖示中加以闡述。 The above overview and the following detailed description and accompanying figures are intended to further illustrate the methods, means, and effects of this invention in achieving its intended purpose. Other objects and advantages of this invention will be elaborated upon in the subsequent description and illustrations.

10:本體 10: Body

11:背部結構 11: Back structure

12:手部結構 12: Hand structure

12A:肩關節單元 12A: Shoulder joint unit

12B:肘關節單元 12B: Elbow joint unit

13:角度感測器 13: Angle sensor

14:驅動馬達 14: Driving motor

141:串聯彈性致動器 141: Series elastic actuator

142:驅動線 142: Drive Line

14A:棘爪與棘輪模組 14A: Pawl and ratchet module

15:電源單元 15: Power supply unit

16:操控介面 16: Control Interface

17:主控制器單元 17: Main controller unit

圖1係為本發明之具安全操作功能之上肢外骨骼裝置實施例 結構示意圖。 Figure 1 is a schematic structural diagram of an embodiment of an upper limb exoskeleton device with safe operation capabilities according to the present invention.

圖2係為本發明欲解決之安全性問題訊號波形示意圖。 Figure 2 is a schematic diagram of the signal waveform of the security issue that this invention aims to solve.

以下係藉由特定的具體實例說明本發明之實施方式,熟悉此技藝之人士可由本說明書所揭示之內容輕易地瞭解本發明之其他優點與功效。 The following describes the implementation of the present invention using specific examples. Those skilled in the art can easily understand the other advantages and effects of the present invention from the contents disclosed in this specification.

本發明之具安全操作功能之上肢外骨骼裝置實施例結構示意圖如圖1所示,該實施例係包括:係包括:一本體10,係穿戴於一使用者上半身,其具有一背部結構11與二手部結構12,該二手部結構分別對稱設置於該背部結構11兩側,適應使用者(人體)的背-肩-手部位,該二手部結構12分別具有一肩關節單元12A與一肘關節單元12B,該肩關節單元12A可額外附加一至多個自由度元件,該肘關節單元12B內設有扭力彈簧;二角度感測器13,係分別設置於該肩關節單元12A內部,用於感測該肩關節單元12A之旋轉角度;二驅動馬達14,係設置於該背部結構11上,分別透過二串聯彈性致動器141與二驅動線142連接至該二手部結構12,並驅動該二手部結構12之肩關節單元12A旋轉,該驅動馬達14並設有棘爪與棘輪模組14A,可用於鎖定或解鎖該驅動線142;一電源單元15,係供應該上肢外骨骼裝置之各元件運作所需之電力;一操控介面16,係為穿戴式介面,可為語音或觸控介面、或兩者皆有,用於發送控制命令;一主控制器單元17,係設置於該背部結構上,係接收 該角度感測器13之旋轉角度訊號與該控制命令,用以控制該驅動馬達、該棘爪與棘輪模組14;該主控制器係根據一導納模型即時調整該上肢外骨骼裝置之系統剛度與阻尼參數,降低使用者因元件故障而受傷之風險。 FIG1 is a schematic diagram of an embodiment of an upper limb exoskeleton device with a safe operation function of the present invention. The embodiment comprises: a body 10, which is worn on the upper body of a user, and has a back structure 11 and a second hand structure 12. The second hand structures are symmetrically arranged on both sides of the back structure 11 to adapt to the back-shoulder-hand area of the user (human body). The second hand structure 12 has a shoulder The shoulder joint unit 12A and an elbow joint unit 12B, the shoulder joint unit 12A can be additionally provided with one or more degree of freedom elements, the elbow joint unit 12B is provided with a torsion spring; two angle sensors 13 are respectively provided inside the shoulder joint unit 12A for sensing the rotation angle of the shoulder joint unit 12A; two drive motors 14 are provided on the back structure 11, respectively through two series elastic actuators 141 and two drive lines 142 are connected to the second hand structure 12, and drive the shoulder joint unit 12A of the second hand structure 12 to rotate. The drive motor 14 is provided with a pawl and ratchet module 14A, which can be used to lock or unlock the drive line 142; a power unit 15 is used to supply the power required for the operation of each component of the upper limb exoskeleton device; a control interface 16 is a wearable interface, which can be a voice or touch interface. The upper limb exoskeleton comprises a main controller unit 17, which is located on the back structure and receives the rotation angle signal from the angle sensor 13 and the control command to control the drive motor, the pawl, and the ratchet module 14. The main controller adjusts the upper limb exoskeleton's system stiffness and damping parameters in real time based on an admittance model, reducing the risk of user injury due to component failure.

本發明使用驅動馬達-串聯彈性致動器(SEA)與驅動線之傳動設計,提供使用者上肢助力功能,該驅動馬達與該串聯彈性致動器間具有棘輪煞車模組(棘爪與棘輪),在緊急狀況下可鎖住驅動線,再搭配本發明之操控介面(友善人機介面語音模組),使用者只要按下按鍵、點選觸控螢幕或以語音命令向外骨骼下達停止命令,棘爪與棘輪便會鎖住驅動線,驅動馬達亦會進入節能待機狀態,節省電池電力消耗。此時外骨骼仍可靠串聯彈性致動器與肘關節處的扭力彈簧提供基本的助力緩衝功能,讓使用者可完成當前動作,例如放下重物後再解決造成緊急狀況的因素,如離開危險場域、排除外骨骼驅動馬達元件故障等等。使用者亦可用語音、穿戴式介面的按鍵等控制命令觸發外骨骼的安全操作模式,讓本發明之上肢外骨骼裝置根據當前運作狀況即時調整系統剛度與阻尼參數,降低使用者受傷之風險,同時達到能源運用效率最佳化。 This invention utilizes a drive motor-series elastic actuator (SEA) and drive cable transmission design to provide upper limb assistance. A ratchet brake module (pawl and ratchet) is located between the drive motor and the SEA, locking the drive cable in an emergency. Combined with the invention's control interface (human-friendly voice interface), the user simply presses a button, taps the touchscreen, or uses a voice command to stop the exoskeleton. The pawl and ratchet lock the drive cable, and the drive motor enters a power-saving standby mode, conserving battery power. At this point, the exoskeleton still provides basic assist and cushioning functions through the series-connected elastic actuators and torsion springs at the elbow joint, allowing the user to complete the current action, such as putting down a heavy object, and then resolve the cause of the emergency, such as leaving a dangerous area or troubleshooting a malfunction in the exoskeleton's drive motor. The user can also trigger the exoskeleton's safe operating mode using voice commands or buttons on the wearable interface. This allows the upper limb exoskeleton device to adjust system stiffness and damping parameters in real time based on the current operating conditions, reducing the risk of injury to the user while optimizing energy efficiency.

本發明之一實施例中,該肩關節單元處可設置一至多個單自由度的接頭、軸承,以符合人體動作需要。 In one embodiment of the present invention, one or more single-degree-of-freedom joints and bearings can be provided at the shoulder joint unit to meet the needs of human body movements.

本發明之一實施例中,進一步提出一種結合有限時間收斂的降階線性擴張狀態觀測器(FRLESO)、自調整代理 滑模控制(PSSMC)、適應性導納控制(AAC)、繩驅式串聯彈性致動器(SEA)、棘爪棘輪煞車模組、以及語音互動與穿戴式介面構成的友善人機介面之外骨骼軟硬體架構,改善主動式上肢外骨骼安全性與系統能源使用效率。首先推導繩驅式主被動雙模式上肢動力外骨骼數學模型,並設計上肢外骨骼的自調整代理滑模控制(PSSMC),改善安全問題。接著同時考慮部分系統狀態及集總干擾的不可量測問題與順應性,在所提出的PSSMC架構下,引入RLESO與AAC提出基於有限時間降階線性擴張狀態估測器之自適應導納代理滑模控制(AAPSMC-FRLESO)。AAPSMC-FRLESO將集總干擾視為擴張狀態進行估測與補償,以提高上肢動力外骨骼在未知參數和時變不確定性下使用者的安全性和助力軌跡的追蹤性能。最終進行軟硬體整合,軟體是兼顧助力、順應性與安全性的控制技術,解決過去主動式上肢外骨骼控制命令通訊過程中,訊號掉點產生抖動、失去穩定以及積分累積誤差造成過大峰值以及震盪效應間接引發之安全性問題,如圖2所示。透過友善人機介面、語音模組、穿戴式介面與棘輪煞車進一步提高安全性,降低手臂因主動上肢外骨骼馬達驅動電路模組故障誤作動,造成使用者受傷的風險,解決使用者雙臂被上肢外骨骼束縛時的安全問題。 One embodiment of the present invention proposes a user-friendly human-machine interface exoskeleton hardware-software architecture that combines a finite-time convergent reduced-order linear expansion state observer (FRLESO), self-tuning proxy sliding mode control (PSSMC), adaptive admittance control (AAC), a rope-driven series elastic actuator (SEA), a pawl-ratchet brake module, and voice interaction and wearable interfaces. This architecture improves the safety and energy efficiency of active upper-limb exoskeleton systems. First, a mathematical model of a rope-driven active-passive dual-mode upper-limb exoskeleton is derived, and a self-tuning proxy sliding mode control (PSSMC) is designed for the upper-limb exoskeleton to address safety issues. Next, considering the unmeasurability and compliance of partial system states and lumped disturbances, the authors introduce the RLESO and AAC within the proposed PSSMC framework to propose an adaptive admittance surrogate sliding mode control based on a finite-time reduced-order linear expansion state estimator (AAPSMC-FRLESO). AAPSMC-FRLESO treats lumped disturbances as expansion states for estimation and compensation, thereby improving user safety and assisted trajectory tracking performance of upper-limb powered exoskeletons under unknown parameters and time-varying uncertainties. Finally, software and hardware integration is performed. Software is a control technology that balances assistance, compliance, and safety. This addresses safety issues previously associated with active upper-limb exoskeleton control command communication, such as jitter and loss of stability caused by signal dropouts, as well as excessive peaks and oscillations caused by accumulated errors, as shown in Figure 2. Safety is further enhanced through a user-friendly human-machine interface, voice module, wearable interface, and ratchet brake. This reduces the risk of injury to the user due to malfunctioning of the active upper-limb exoskeleton's motor drive circuit module, thus resolving safety issues associated with users' arms being restrained by the upper-limb exoskeleton.

導納控制是根據人機交互力的大小來控制位置,所以人機交互力是輸入,位置是輸出,在討論導納控制前,需 對人機交互力的獲取進行探討。在交互方式中,力訊號是指人體肌肉收縮作用於機械結構所產生的作用力,在控制系統中稱為交互力,其可透過力感測器、馬達電流迴路等方式直觀的測量。使用力訊號量測不僅可以避免貼肌電貼片量生物訊號的不便,還可以更直觀的辨識穿戴者肢體的運動意圖,故本發明使用力訊號量測方式作為動力外骨骼導納控制的人機交互力輸入。目前,力訊號的量測方式包含以下幾種。(1)力矩感測器:其動態性能好且技術成熟,但機械結構較為複雜,很難用在對體積有嚴格要求的動力外骨骼上;(2)諧波減速器:此種量測方式透過測量諧波兩側的角度差,即可達到與力矩感測器相同的效果,但其諧波變形特性非常複雜,而且存在固定頻率的轉矩波動,導致此類研究非常稀少;(3)關節電流:該方式的力測量是透過獲取馬達輸出電流,在剝離外骨骼關節動力學所產生的部分,以獲得人機交互力,此種方式無需週邊感測器,結構簡單成本低,但由於受齒輪與結構等摩擦力的影響,難以精確計算,導致控制精度較低;(4)串聯彈性致動器:此種量測方式在驅動端和負載端增加一個彈性元件,藉由測量彈性元件的形變量計算人機交互力,在本發明應用中,透過在彈性元件外側增加磁性位置編碼器進行變形量量測,從而計算出人機交互力,透過此種方式構成的外骨骼關節被稱為串聯彈性驅動,該方式也是目前機器人力控制中最熱門的研究方向之一。導納控制的目的是實現力到位置的轉換,透過位 置控制使動力外骨骼具有良好的順應性,本發明採用基於位置的阻抗控制、即導納控制,以實現動力外骨骼人機協同的順應性、舒適性及在產生大軌跡追蹤誤差的過阻尼安全響應,避免因外力產生無法收斂的震盪現象導致危險或傷害。 Admittance control controls position based on the magnitude of the human-machine interaction force. Therefore, the human-machine interaction force is the input, and the position is the output. Before discussing admittance control, it is necessary to explore how to obtain the human-machine interaction force. In interaction methods, force signals refer to the force generated by human muscle contraction acting on a mechanical structure. In control systems, this force is referred to as interaction force and can be measured intuitively using force sensors, motor current loops, and other methods. Using force signal measurement not only avoids the inconvenience of applying electromyographic patches to measure biosignals but also allows for more intuitive identification of the wearer's limb movement intent. Therefore, this invention uses force signal measurement as the human-machine interaction force input for admittance control of a powered exoskeleton. Currently, force signal measurement methods include the following. (1) Torque sensor: It has good dynamic performance and mature technology, but its mechanical structure is relatively complex and it is difficult to use in powered exoskeletons with strict volume requirements. (2) Harmonic reducer: This measurement method can achieve the same effect as the torque sensor by measuring the angle difference between the two sides of the harmonic, but its harmonic deformation characteristics are very complex and there are torque fluctuations with a fixed frequency, which makes this type of research very rare. (3) Joint current: This method measures force by obtaining the motor output current and separating the part generated by the exoskeleton joint dynamics to obtain the human-machine interaction force. This method does not require a cycle. Edge sensors have a simple structure and low cost, but are difficult to calculate accurately due to the influence of friction between gears and structures, resulting in low control accuracy; (4) Serial elastic actuator: This measurement method adds an elastic element to the driving end and the load end, and calculates the human-machine interaction force by measuring the deformation of the elastic element. In the application of this invention, a magnetic position encoder is added to the outside of the elastic element to measure the deformation, thereby calculating the human-machine interaction force. The exoskeleton joint constructed in this way is called serial elastic drive, which is also one of the most popular research directions in human control of machines. The purpose of admittance control is to convert force into position. Position control provides the exoskeleton with excellent compliance. This invention employs position-based impedance control, also known as admittance control, to achieve compliance and comfort in human-robot collaboration within the exoskeleton. It also provides an overdamped safety response to large tracking errors, preventing unresolved vibrations caused by external forces that could lead to danger or injury.

導納控制按照控制過程中模型參數是否自動變化可分為固定參數導納控制和變參數導納控制,固定參數導納模型需要人工調節以獲得合適的順應性較為煩瑣,變導納模型透過改變導納參數進而依據實際需求自動調節順性。根據過去的研究可知,當穿戴者要有良好的追蹤性能時,需要較高的阻尼和較低的速度來實現準確運動,相對的,當穿戴者要進行大範圍的移動時,需要較低的阻尼來實現快速移動。正因為這種來自於穿戴者的個人因素,穿戴者的操作力和輸出速度的關係會處於一個動態變化的狀態。因此,動力外骨骼的順應控制需滿足以下需求:(1)低速時的運動準確性;(2)全域的人機交互力穩定性;(3)靈敏的高低速切換能力。為此本發明採用自適應導納控制策略以優化人機交互的順應性。動力外骨骼在助力輔助過程需要與手臂進行人機交互,採用FRLESO-PSSMC可以保證使用過程的安全性,但是在涉及到與人體接觸時一般採用導納控制作為順應制策略,導納控制是一種基於力的順應控制策略,可以透過建立與位置的關係達到順應控制的目的。因此,本發明在FRLESO-PSSMC的基礎上引入自適應導納控制,以突破傳統阻抗控制的僵硬局限,導 納控制是將量測的人機交互力輸入導納模型,獲取追蹤軌跡的角度修正量,進而調整關節的預設追蹤軌跡,以提高人機交互的順應性與舒適性。本發明針對外骨骼系統所設計的AAPSMC-FRLESO,在未知參數和不確定性的狀態下能確保助力輔助的安全性和助力軌跡的追蹤性能,同時還能滿足個體化差的穿戴順應性。 Admittance control can be categorized as fixed-parameter admittance control and variable-parameter admittance control, depending on whether the model parameters automatically change during the control process. Fixed-parameter admittance models require manual adjustment to achieve appropriate compliance, which is more cumbersome. Variable admittance models automatically adjust compliance based on actual needs by varying the admittance parameters. Previous research has shown that for good tracking performance, high damping and low speed are required for precise movement. Conversely, for large-scale movement, low damping is required for rapid motion. Because of these individual factors, the relationship between the wearer's operating force and output speed is subject to dynamic change. Therefore, the compliance control of the powered exoskeleton must meet the following requirements: (1) motion accuracy at low speeds; (2) full-range human-machine interaction force stability; and (3) sensitive high-low speed switching capabilities. To this end, the present invention adopts an adaptive admittance control strategy to optimize the compliance of human-machine interaction. The powered exoskeleton requires human-machine interaction with the arm during the power assistance process. The use of FRLESO-PSSMC can ensure the safety of the use process. However, when it comes to contact with the human body, admittance control is generally used as a compliance strategy. Admittance control is a force-based compliance control strategy that can achieve the purpose of compliance control by establishing a relationship with position. Therefore, this invention introduces adaptive admittance control based on the FRLESO-PSSMC to overcome the rigid limitations of traditional impedance control. Admittance control involves inputting the measured human-machine interaction force into an admittance model to obtain an angle correction for the tracking trajectory. This correction then adjusts the preset tracking trajectory of the joint to improve the compliance and comfort of human-machine interaction. Designed for exoskeleton systems, the AAPSMC-FRLESO of this invention ensures the safety of power assistance and the tracking performance of the power trajectory under conditions of unknown parameters and uncertainty, while also meeting the requirements for individualized wearability.

一般協作型機械手臂採用的導納模型如下: The admittance model commonly used by collaborative robotic arms is as follows:

其中V θ(s)為角速度,F I (s)為人機交互力,IBK分別為系統的等效慣量、阻尼和剛度。由於本發明所控制的上肢動力外骨骼,其在關節助力抬舉或搬運重物過程的加速度變化較小。因此,本發明所採用的導納模型忽略(1)式的慣量參數,將導納模型簡化為: Where ( s ) is the angular velocity, FI ( s ) is the human-machine interaction force, and I , B , and K are the equivalent inertia, damping, and stiffness of the system, respectively . Because the upper limb powered exoskeleton controlled by the present invention has a relatively small acceleration change during the process of lifting or carrying heavy objects with joint assistance, the admittance model used in the present invention ignores the inertia parameter in equation (1) and simplifies the admittance model to:

由(2)式可以進一步獲得人機交互力與追蹤軌跡修正量△θ的關係為: From equation (2), we can further obtain the relationship between the human-computer interaction force and the tracking trajectory correction value △θ:

固定參數的導納模型無法因應不同穿戴者的個體化差異,即時調整動力外骨骼系統的順應性,且針對不同情境的助力需求,模型參數需要人工調整以獲得合適的順應性,根據過去 研究可知,當穿戴者需要良好的步態追蹤性能時,需要較高的阻尼和較低的速度來實現準確運動;當穿戴者需要大範圍移動時,需要較低的阻尼來實現快速移動。因為這種來自於個體化的差異及穿戴外骨骼的順應舒適性需求,人機交互力與輸出速度的關係會處於一個動態變化的狀態。因此,本發明採用自適應導納的控制方式優化人機交互體驗,為減低控制平台的運算負擔,本發明將外骨骼導納模型的參數調整律(由該主控制器單元控制)設計為: Fixed-parameter admittance models cannot adapt to the individual differences of different wearers and adjust the compliance of powered exoskeleton systems in real time. Furthermore, model parameters must be manually adjusted to achieve appropriate compliance based on the assistance requirements of different scenarios. Previous research has shown that when the wearer requires good gait tracking, higher damping and lower speed are required for accurate movement; when the wearer requires a wide range of motion, lower damping is required for rapid movement. Because of these individual differences and the need for exoskeleton compliance and comfort, the relationship between human-machine interaction force and output speed is in a state of dynamic change. Therefore, the present invention adopts an adaptive admittance control method to optimize the human-computer interaction experience. To reduce the computational burden of the control platform, the present invention designs the parameter adjustment law of the exoskeleton admittance model (controlled by the main controller unit) as follows:

其中為剛度調整係數,為阻尼調整係數,θ E(t)為角度感測器所測得之關節角度,θ M為關節的最大轉動角度,K0為剛度基準值,B0為阻尼基準值,K(t)為系統需增加之剛度值,B(t)為系統需增加之阻尼值。當上肢跟隨外骨骼運動時,外骨骼需要抬升上肢至期望角度,期望角度與實際角度差值較大時,透過增加導納剛度,可以確保在較大的人機交互力下輸出角度補償量不會過大,隨著外骨骼關節慢慢上抬關節角度,所需助力值减小的同時,剛度變量也减小。 in is the stiffness adjustment coefficient, is the damping adjustment coefficient, θ E (t) is the joint angle measured by the angle sensor, θ M is the maximum rotation angle of the joint, K 0 is the stiffness baseline value, B 0 is the damping baseline value, K(t) is the required stiffness value for the system, and B(t) is the required damping value for the system. When the upper limb follows the exoskeleton's movement, the exoskeleton needs to raise the upper limb to the desired angle. When the difference between the desired angle and the actual angle is large, increasing the admittance stiffness ensures that the output angle compensation is not excessive under large human-machine interaction forces. As the exoskeleton joint gradually raises the joint angle, the required force decreases, and the stiffness variation also decreases.

藉此,本發明係提供一種具安全操作功能之上肢外骨骼裝置,本發明使用安全控制技術,解決過去主動式上肢外骨骼控制命令通訊過程中,訊號掉點產生失去穩定、抖動以及積分累積誤差造成過大峰值震盪效應產生之安全性問題, 並兼顧順應性。本發明之友善人機介面語音模組可使棘輪煞車鎖定,降低手臂因主動上肢外骨骼馬達驅動電路模組故障誤作動,造成穿戴者受傷的安全性問題,同時解決過去主動式上肢外骨骼電池能源續航力問題。 Thus, this invention provides an upper limb exoskeleton device with safe operation. This invention utilizes safety control technology to address safety issues previously encountered in active upper limb exoskeleton control command communication, such as signal dropouts leading to loss of stability, jitter, and excessive peak vibrations caused by integrated cumulative errors. While also ensuring compliance, this invention also incorporates a user-friendly human-machine interface voice module that locks the ratchet brake, reducing the risk of injury to the wearer due to malfunctions in the active upper limb exoskeleton's motor drive circuit module. It also addresses the battery life issues previously encountered with active upper limb exoskeletons.

上述之實施例僅為例示性說明本發明之特點及其功效,而非用於限制本發明之實質技術內容的範圍。任何熟習此技藝之人士均可在不違背本發明之精神及範疇下,對上述實施例進行修飾與變化。因此,本發明之權利保護範圍,應如後述之申請專利範圍所列。 The above embodiments are merely illustrative of the features and functions of the present invention and are not intended to limit the scope of the substantive technical content of the present invention. Anyone skilled in the art may modify and alter the above embodiments without departing from the spirit and scope of the present invention. Therefore, the scope of protection of the present invention shall be as set forth in the patent application described below.

10:本體 10: Body

11:背部結構 11: Back structure

12:手部結構 12: Hand structure

12A:肩關節單元 12A: Shoulder joint unit

12B:肘關節單元 12B: Elbow joint unit

13:角度感測器 13: Angle sensor

14:驅動馬達 14: Driving motor

141:串聯彈性致動器 141: Series elastic actuator

142:驅動線 142: Drive Line

14A:棘爪與棘輪模組 14A: Pawl and ratchet module

15:電源單元 15: Power supply unit

16:操控介面 16: Control Interface

17:主控制器單元 17: Main controller unit

Claims (9)

一種具安全操作功能之上肢外骨骼裝置,係包括:一本體,係穿戴於一使用者上半身,其具有一背部結構與二手部結構,該二手部結構分別設置於該背部結構兩側,該二手部結構分別具有一肩關節單元與一肘關節單元;二角度感測器,係分別設置於該肩關節單元,用於感測該肩關節單元之旋轉角度;二驅動馬達,係設置於該背部結構上,分別透過二串聯彈性致動器與二驅動線連接至該二手部結構,並驅動該二手部結構之肩關節單元旋轉;一操控介面,係由該使用者穿戴,用於發送控制命令;一電源單元,係供應該上肢外骨骼裝置之各元件運作所需之電力;一主控制器單元,係設置於該背部結構上,係接收該角度感測器之旋轉角度訊號與該控制命令,用以控制該驅動馬達;其中該主控制器單元係根據一導納模型即時調整該上肢外骨骼裝置之系統剛度與阻尼參數,降低使用者受傷之風險。 An upper limb exoskeleton device with a safe operation function includes: a main body, which is worn on the upper body of a user, and has a back structure and a second hand structure, the second hand structure being respectively arranged on both sides of the back structure, and the second hand structure having a shoulder joint unit and an elbow joint unit; two angle sensors, which are respectively arranged on the shoulder joint unit for sensing the rotation angle of the shoulder joint unit; two drive motors, which are arranged on the back structure and connected to the second hand structure through two series elastic actuators and two drive lines , and drives the shoulder joint unit of the second hand structure to rotate; a control interface, worn by the user, for sending control commands; a power supply unit, for supplying power to the various components of the upper limb exoskeleton device; a main controller unit, located on the back structure, receives the rotation angle signal from the angle sensor and the control command to control the drive motor; the main controller unit adjusts the system stiffness and damping parameters of the upper limb exoskeleton device in real time based on an admittance model to reduce the risk of injury to the user. 如請求項1所述之具安全操作功能之上肢外骨骼裝置,該驅動馬達係為直流無刷馬達。 In the upper limb exoskeleton device with safe operation function as described in claim 1, the drive motor is a brushless DC motor. 如請求項1所述之具安全操作功能之上肢外骨骼裝置,其中該肘關節單元係設置有一扭力彈簧。 The upper limb exoskeleton device with a safe operation function as described in claim 1, wherein the elbow joint unit is provided with a torsion spring. 如請求項1所述之具安全操作功能之上肢外骨骼裝置,其中該驅動馬達具有棘爪與棘輪,用於鎖定或解鎖該驅動線。 The upper limb exoskeleton device with a safe operation function as described in claim 1, wherein the drive motor has a pawl and a ratchet for locking or unlocking the drive line. 如請求項1所述之具安全操作功能之上肢外骨骼裝置,其中該操控介面係為觸控式控制器或語音式控制器。 The upper limb exoskeleton device with safe operation function as described in claim 1, wherein the control interface is a touch controller or a voice controller. 如請求項1所述之具安全操作功能之上肢外骨骼裝置,其中該主控制器單元係以CAN bus與該角度感測器、該驅動馬達通訊。 The upper limb exoskeleton device with safe operation function as described in claim 1, wherein the main controller unit communicates with the angle sensor and the drive motor via CAN bus. 如請求項1所述之具安全操作功能之上肢外骨骼裝置,其中該操控介面與該主控制器單元間係以藍牙傳輸資訊。 The upper limb exoskeleton device with safe operation function as described in claim 1, wherein information is transmitted between the control interface and the main controller unit via Bluetooth. 如請求項1所述之具安全操作功能之上肢外骨骼裝置,其中該驅動線係為繩索、鍊條、皮帶或其他種類之柔性傳動裝置。 The upper limb exoskeleton device with safe operation function as described in claim 1, wherein the drive line is a rope, chain, belt or other type of flexible transmission device. 如請求項1所述之具安全操作功能之上肢外骨骼裝置,該主控制器單元之導納模型為: 其中ħ為剛度調整係數,為阻尼調整係數,θE(t)為角度感測器所測得之關節角度,θM為關節的最大轉動角度,K0為剛度基準值,B0為阻尼基準值,K(t)為系統需增加之剛度值,B(t)為系統需增加之阻尼值。 In the upper limb exoskeleton device with safe operation function as described in claim 1, the admittance model of the main controller unit is: Where ħ is the stiffness adjustment coefficient, is the damping adjustment coefficient, θE (t) is the joint angle measured by the angle sensor, θM is the maximum rotation angle of the joint, K0 is the stiffness reference value, B0 is the damping reference value, K(t) is the stiffness value that needs to be increased in the system, and B(t) is the damping value that needs to be increased in the system.
TW113149645A 2024-12-19 2024-12-19 Upper limb exoskeleton device with safe operation function TWI901483B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
TW113149645A TWI901483B (en) 2024-12-19 2024-12-19 Upper limb exoskeleton device with safe operation function

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW113149645A TWI901483B (en) 2024-12-19 2024-12-19 Upper limb exoskeleton device with safe operation function

Publications (1)

Publication Number Publication Date
TWI901483B true TWI901483B (en) 2025-10-11

Family

ID=98264061

Family Applications (1)

Application Number Title Priority Date Filing Date
TW113149645A TWI901483B (en) 2024-12-19 2024-12-19 Upper limb exoskeleton device with safe operation function

Country Status (1)

Country Link
TW (1) TWI901483B (en)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111631726A (en) * 2020-06-01 2020-09-08 深圳华鹊景医疗科技有限公司 Upper limb function evaluation device and method and upper limb rehabilitation training system and method
US20240045500A1 (en) * 2013-07-05 2024-02-08 Haptx, Inc. Whole-body human-computer interface

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20240045500A1 (en) * 2013-07-05 2024-02-08 Haptx, Inc. Whole-body human-computer interface
CN111631726A (en) * 2020-06-01 2020-09-08 深圳华鹊景医疗科技有限公司 Upper limb function evaluation device and method and upper limb rehabilitation training system and method

Similar Documents

Publication Publication Date Title
CN111390877B (en) Exoskeleton device and exoskeleton variable admittance control method
CN111281743A (en) Self-adaptive flexible control method for exoskeleton robot for upper limb rehabilitation
CN110703604B (en) Exoskeleton dynamic model parameter identification method and exoskeleton device
CN104191429B (en) The mixing control method of a kind of tendon driving device hand position and tendon tension force and control device
CN110834329B (en) Exoskeleton control method and device
CN108214458B (en) Wearable upper limb robotic arm
CN110673544A (en) Upper limb rehabilitation robot control method based on adaptive online learning
CN113843801A (en) Control method, device and system for composite robot
CN110251898A (en) A closed-loop control system for wrist rehabilitation exoskeleton based on force feedback
Zhu et al. Adaptive control of man-machine interaction force for lower limb exoskeleton rehabilitation robot
CN112237524A (en) Control method for passive rehabilitation training of flexible upper limb rehabilitation robot
CN114721258B (en) Backstepping control method for lower extremity exoskeleton based on nonlinear extended state observer
CN112388616B (en) Adaptive robust force control method and device for under-actuated support leg assistance exoskeleton
Sun et al. Human–robot interaction force control of series elastic actuator-driven upper limb exoskeleton robot
TWI901483B (en) Upper limb exoskeleton device with safe operation function
CN109498366B (en) System for assisting arm movement
CN119911341B (en) Wheel-foot robot, robot system, motion control method and motion control system
CN114129392A (en) Adaptive redundant drive exoskeleton rehabilitation robot with adjustable distal fingertip force
Yin et al. Modeling and control strategy of flexible joint servo system in humanoid manipulator driven by tendon-sheath
CN110587613B (en) A real-time feedback and closed-loop control method for negative pressure pneumatic flexible knee joint exoskeleton
Yuan et al. Design of adaptive compliance control algorithm for upper limb exoskeleton rehabilitation robot
Wang et al. A control strategy for squat assistance of lower limb exoskeleton with back sensing
CN108789374A (en) A kind of non-anthropomorphic upper limb assistance device and its control method
Ai et al. Design and control of a cable-driven series elastic actuator for exoskeleton
CN113799099B (en) Driving assembly, active exoskeleton movement module and active exoskeleton robot