You are on page 1of 10

3 '2 4 101 2. '+/ ,*+ , ' - " ' ) .

%& ' ( ) *+ ,

6 7. 7. 51 2 . 3 4 - . - / 01 +4 1 " ' 56
*
6 7. 7. 51 2 . 3 4 1 8 7+ )
6 7. 7. 51 8 . 3 4 . :;- < /= >
3

?
. A . I FG ; >9 6 4 ?. 9 . @ - 96 4 A 5 . 9 B:C > - ?DE- < . / ;/ : 9
50

: 2: ; :; NO- 6 9 9 /> - - 9 6 9 9 2 91 J9 A . . - 3 1 L M < . J9 C K


J9 2 9 U :E 3L /> @ > > .6 L ( T A . ; P; Q R BS 1 6 9 C J?DE 9 /;
4

X . ZM S ; 9 L 9 4 7 O. X . 9X C JY Q 9 . 4 W 6 / > L 3V L M < .
\] U A 9 T<C X . !. . - C K [ .- 4 /> . ZM ; 9 /> @ > > .6 L / U
10-1 !"# 1399

ZM SX . c _ J R 9 [ .- 4 /> . ZM ; ; 6 1 BR C b . 4 _ . 9 `< a ^ 2 : .
. / 5; e <Z 9 T<C !. 9 M 9 / 3 1 U A d:; > A :O
. [ .- 4 ; /> @ > > .6 L U L M < . J 9 :3 , 3 ; @'7

Control of the Exoskeleton Waist Robot by Using Parallel Distributed Compensation


Controller

M. Esfandiarfar Department of Mechanical Engineering, Yasouj University, Yasouj, Iran


B. Rahmani Department of Mechanical Engineering, Yasouj University, Yasouj, Iran
A. Dehghani Department of Computer Engineering, Yasouj University, Yasouj, Iran

Abstract
Musculoskeletal disorders caused by heavy workloads are very common in workers, which negatively affects workers' health and
productivity. In this regard, the idea of designing an exoskeleton robot is proposed. This robot is similar to a dress which worn on the
user's body and parallels the body, accompanying and helping the person. In this paper, the parallel distributed compensation control
method is proposed to be applied to a four degrees of freedom exoskeleton waist robot. Initially, the dynamical equations governing
the system are extracted. According to the nonlinear nature of the system, the parallel distributed compensator controller is designed
with a Takagi-Sugeno linearization approach. The closed loop system response of this controller is investigated in the Simulink
environment of the MATLAB software. The results show that the Takagi-Sugeno linearization approach accurately estimates the
nonlinear system, and also the proposed controller perfectly intercepts the optimal closed loop response.
Keywords: Exoskeleton Robot, Parallel Distributed Compensation Controller, Takagi-Sugeno Approach.

BS - 6 . > I 1226 A 9 > 1; n .[2] . 9


- ^0 6 > -a ^ <E 51 9 9 / ;6 . : 9 : -1
> %34 - : V 6 . > %44 A 5 K 9 9 f9 ?DE- < . JY? M A @ - > :
A 9 9 .[3] . - ( a4 : <E 9 / / ; S XT F 1 2 6 6 4 Fg DC 9 .
9 6 4 ?. 9 X0C / \ ] q 5 f A 5 . / ; 9 U :E : > 9 <R / ; <E > .
9 - ?DE- < . JY? M 9 0 A . 31 / I h A X3 . . : C 9 / ^ / ; 9 A d:;
. A :; . ; P; J - 9 6 /] / ; 9 U :E B R I A 9 . . 6 9 6> B:] / : / ; 3
3L BC 2 6 E 9 L M < . / ;J 9 C K A . 4 J T 6 . B 1 > 9 iE 9 6 9 9 A 5 .
.[4] . - r Z ; M ; >9 /; ?. P a J M 6 L - / ; a; P a iE 9 j k
;- 2 9 Q R 4X1V / ; 1 9 L 9 5% Y . U m 6 E 9 . 0 / LP V2 6 > -
s< O / ; > > .X ; 6 4 > 9 s< O / ;J 9 - NM : <E 9 > > 2 B_ C 6 4
I a. 9 PT Q R : / >9 2 6 E 9 J9 ?DE- < . JY? M 6 3L U . Y < 20 C
_ 9 O. \ - ; ^0 ;J 9 V / ;PO9 > : / ; a; - a; 9\
2 9 / ;X . . 19 I ; >9 Y9 E . j - 6 51; n A d:; .[1] :- 9 6 <R
- 9 \. / M. L M < . 9 9 . 45 A. A 5 9 6 . 6 :
A . B:E 6 6 9 9 q ; :; /> J R 9 - 61% 9 9 . 31/9 A. A 5 9 : 6 . 6 47%
*
b_rahmani@yu.ac.ir : 1

97/11/30 : !
98/12/05 :( ) !
-9 - / C [ 6 : C K 4Y[ ( 6 L Q. J 9 J _ 6 ( ; 2: 9 X .
W J9 Q 2 : . 9 > 6 9 5 PID U 2 ( 5<:E 2: 9 J _ P a 9) 6 6 9 / ;sQk

L M < . J9 U
/ 8 B Q X . 2 [19] 6 :; . . : iE 9 6 A (6 / :- ; P a ) J 9 / ;sQk 6 L
9 . 6 15 J C 6 :K <9 _ P a / 9 6 |E-a~ <9 _ 3 9 J9 6 - / L / : 0
7
. : Q 4 /a~ / ;P > 2: v L M < . J9 . 4 LJ R 9 6 9 9 .
2 . 6 15 <:E 39 { ; 9 [20] 6 :; v • .[5] 4 U :E . 9 J . ; B <] >

6
/ 9 M. : C K 8 9 ^ 9 K PO J9 <x / . 9 9 w > L M < . / ;J 9

I. 9
> M . 6 15 C J _ /a~ . <E 9 / 9? 6 :9> . ;J 9 U / . y - X T
J9 <:E 0 . ]R / 9 . - 9 . 6 . /; sQk 1 (U <Q ) C J? 1

>
b 4 ^0 : 9 X . > ; 4 9 ;P > 9 ` . > - z :E C sQk A . 6 L ;6 a

U
< . / ;J 9 > C 1; n . - J F J 9 A PO9 :F { ; . ;J 9 ^ . . . / :9 . 34

...
( 2 [21] 6 :; / ( ] / ;^ ) A L M U A 5 . 9 B:C > :C 9 ?DE / Pa
B3 w 9 : W A L M < . / 9 UT 6 a : c K > ;X . A .[6]
. <E 9 A 9 ? / 39 J9 9 A9 E?K / ;U 5 . J _XT
2 [22] <: Q0 5 -? . 4 I . /a~ - 9 T. E . J _P a 9 0 X;
1
U 3L 3 1 /> / E _ 9 U /; 5 C > I . 9 L M < . / ;J 9 .[7] -
2
9 4 _ I. :9 : ZT B9 T / 5 C 14 Q_ > /; 5 C s< O
9 -U / / > E. 14 v 8 U - F w] ; . Qk e |E N O1 / ; 5 C
N O1 / 9 / L ( [23] 6 :; . : U :E X . J : :| /a > 2 9 J E?K A U . 9
( A . : 31 ( 96 B Q |_ - - K6 :; . 4 } O J 9 e <Z <:E / 9
9 4 s Q 6 9 U Q €IC @L 6 E 9 6 |_ / 9X T B9 _ Q R . 9 ;J 9 A / ; 9
9 B:C / 9 > 14 9 |_ N O1 X 5 C K - J E B _> / 96 >C . .
. - /> . 39 ] : L JY? M 9 ? 6 : 9 1O96 6 : . / 9 /
P- J R 9 z :E J _ T L M < . / ;J 9 6 : 9 1O96 [9] A 9 - b< 6 6 U Q [8
4A . . - W A ^ : ] _ / ;^ > < _ / ;^ 1O96 [10] E O A a J R 9 ?
9 0 / 9 3L B9 _ J _ XS <E ;J 9 96 w QR 9 >C . - [11] ]
9 U |] /Y 9 / a; C/; ] <:L > <W T [12] 6 : 9 U T 6 . 9 2: 3L /
A 5 . : / ; > B:C ; 9 K > . . . - [14 13] 6 4 6> 9 . J _
A 9 9 . > B P- 9 L M < . / ;J 9 L M < . J 9 2 [15] 6 :; ; 1; n
rZ ; P- J?DE > DQ9 3 ;J 9 C K 0 9 X . / / ; 4n . 9 ( _ / ;^ ) Y 9
- 6 : a; J 9 ./ 9 9 0 A . - 9P X 5 / 9 <C C / D ZM U 2
/ > L 3V J _ P a J 9 2 U P; n A . - P; 9 - W X . / ; QZ_ ^ E @ 3L X .
<:L > Q R / ; 9 3L / 3 1 6 L M < . . ; Pa 6 ; >9 X . L JY? M
Q > v . . 4 _ w • 6 . 6 4 I. J 9 2 / 9 3/> 0 a0 ( [16] 6 :;
U <• 9 X C 2 7 O . / 3 1 J9 : U :E / > L I; / 6 / > 9 L M < .
W [ .- 4 /> . ZM ; 9 /> @ > > .6 L . . 9( A > / I b . U C
\] / 31 U /> . - > v . 4 9 d / ;X . a0 B - /> 0 a0 (
_ / 40 i]9 /> . - b `< 2 : . U J .] ^0 / 9 . > I . ;X . >
. 4 . .
2 4 ^ 0 [17] 6 :; q ; \. 1; n
5 4+C -2 > I . 9 _ / ;^ C |_ 9 3L : 6 J 9
- 9 C / 31 L M < . J 9 P; n A 9P _ P a / 9 <C - C K /; 5 C
9 L M < . 2 [18] 6 :; 4. - W 6
4
Modular
5
Proportional–Integral–Derivative (PID)
6 1
Brain-Neural Computer Interaction Sensor
7 2
Electrooculography (EOG) Load cell
8 3
Bravo Virtual Decomposition Control (VDC)

2
I. Xm 9 2: 3L ; Q. 9 \. 9 - )4
/ ; 9 / :E - ^0 /; . 9 c K . U :E 9
L/ ] I 2 J R 9 6 4 \. -B:C
B:C 4 - T Z :; . ^ 4 < 20 15
:C > 39

6 4 ?DE- < . ‚ E 0 iE 9 ^ J R 9 ; 9
L 4 2 R : 6 E 9. - 9 1 BS 1
•E

UQ 6 J9 Q A UK : <9 4 < 20
3 J 9 ` L > 2: ^ 4 < 15 ‚ 9 I4 6 -9
T;

: /; 3 9 4< 5^L2 6 <9 U Q /


31 X . A m J F J• > A 9 9 -
9 :E 14 P; R J9 A ; A 9 9 . 4
: / ; 3 9 / L / ;` . -9 : /; 3
\ ?DE- < . ‚ E . : 2 4 >6 9
. ; P;
3-' F ( -7 8'+E ( ) ; -1 D
- Q 6 <:E / 3 1 J 9 : _A
W U U :E 3L X . 9 X C 2
6 6 \ 3L . / 4 9 J9 M.
4 C K/ 4 9 9 L M < . J9 . 4
/ 14 . - Q / >9 :
> / ;X . > 9 9 C C 9 ?E
. - BT 6 9 9 : 9 B| 2 c K >
L M ƒ aL a . /; ;
4 _ 9 - 9 C : 5 ; 6 9 Y 9 9 2:
6 9 4 . ; . 9 L 9 J9 A C K . ;
: 9 : / - U :E : 9 14
^0 . 175 C _ 9 2 6 9 Q9 . 9 6
^5 ; / :; 3L J 9 A ^a . 4 U :E 9
4 ^ 0 Solid work a ^ \ ] C K A . . -
C K (: 6 - . XM A C ) 9 A - )4 A - 9
. .
CA / I h J9 / AC 4
. 4 _ NO- C 9 q ; :;
/ ;P N O1 I h J 9 - Q / 5 C . %& ' ( ) -1-2
J E?K A 3E 9 J 9 / > 9 9 6 A9 U :E 9 ; _ 4 9 6 / 3 1 J9
; . - U . /a > 9 / ;v J R 9 ; P; : /; 3 9 P : 9 : /
9 6 `TE <L C N O1 . B. / 2 3V . 1O9 39 6 4 ?DE- < . ?. Q.
> 14 5 C J E?K (> 9 ; ^0 QI / > L UQ / > L > J9 / > L
9 - / 6 E 92 >/ 4 3L /; 9f 9 UQ / > JL . . -B 1
9 C N O1 X . <:E / ] . 4 U :E ; Q 9 C / > P a 3L QI / > J L
. . - „ 1 5-3 PO9 /; 5 C/; > I . : B - J9 A / .: / ] 9 L 9. 4
. ; 1B -. - I4 " 6 " J 9 6 9 . 6 A5
. ; 61 6 / > JL J9 - C K
5 +) 5, 8 1- (G- C -2-2
. . -B 1 PO9 > .A
2B - ` 9 PO9 > /: |
. . - P : 3B -

[24] 1+ H' ' -' F 3 -2 D

Q n 4Y ( > I . 9 J9 PO9 Q

3
L M < . J 9 . :. / 9 X . JY Q 6 _ c K (1X T 6 L L ‚ 9)
. . 9 1 a †V : / 9 JY Q A . 9 6 .[24] - 7 O . s3- B {? M

L M < . J9 U
. . ZM S <:L . 31 (7) Q K6 :;
9 . 4 _ ZM S / . X . 2 - iE 9
/ 9 ZM S / ; U X . ZM S ; 9 L
. - ; M . 9 X . 9 U :E

6
I. 9
,*+ , -3
2 / 9 4B <] C 2 6 E 9 U

>
X . 2 ; / . . - rZ X .

U
3
2 > I . e <Z / 9 T<C !. 9 6 6 . IJ) -' F 3 -3 D

...
. . a `. / 4 I 9 U
ZM / . ; U 6 w 2 > 9X . PO9 9 X C Q
6 w X .2 9 L 9 _ ZM S 14 T 4 7 O . (2) (1) Q ^ 9 `
/ ; E :0 . _ I. `. / U T ( -9 T -1 S 14 B - ) 9 :.
/ ;X . > 9 / ; > 9 39 3L Q R L P 4 e - g 6 9 B| / > 9 6> m / 14
ZM S ; 9 L 9 T A . I. V t 6 9 B| 2 / > Q_ θ 6 9 B| 2 U K
- 4 /> . ZM ; > 9 / 3 1 J9 2 . 9 :E 6 Li t :E [
9 6 J 9 ZM S U c _ A :O / 9 4 [ . . . v T /
mL mgL
I θ sinθ # T $T
4 2
U > v8. 4 I . /> X . > > />
(1)
di t
. - I. J9 A U / 9 /> / @ > > .6 L
V t #L Ri t V'
dt (
\. BT K 9 J9 - Q ; . } B9 _ (2)
a0 X . @_ - ; X .A Pa P; 3L N B 9 QL
. ; ; A … ZR > w { R 9 U C . - I. 6 14
61 / > E . 14 A 9 f (3) Q QL
'+/ ,*+ , 7 2 1@ - K , . &4 ; -1-3 . ;
ω T 1 T
N# # & #
ω T' N T
ZM S / ;U 6 _ 9 [ . - 4 /> / ;U (3)
J R 9 ZM S / ;X . e ] E :0 2 XT 6 L /; T \. - 14
] X . ZM S J E ; { ; A / 9 . : s R B . . 9 (4) Q cK
` J R 9 : ƒk / C ZM S f - U T #K i (4)
JY Q . A :; 9 . - Q ZM J E /> c9 Z E . 9 `. 2
] k[
9 ZM / ;X . > > / E :0 9 X . ZM S . 4 Q (5 ) Q
A /> c I< / 4 9 - X T NO1 DE L V' ( #K ω (5)
. 4 ZM S X . U c _ 9 > 9 iE 9 ; E :0 < 6 _> / > C /> .U / 9 (6) Q
/ 9 ZM / ; U > I . 6 /> cZ > I . 9 . I.
2 A - X; ( A 2: 9 ZM S / ;X . J ω/ # T $ T # $ T' bω (6 )
> . 6 9 3L .[25] . [ .- 4 U ; / 9/ 9 6: J 9 :. 9 > - BT 14 T' 6
~ 4 9 ZM S X . 2 U ; A 8 ` kb C . 14 J ω/ .
: . >^ 96 > L M6 / 5 C I#
1

2
(7 ) Q 2 Q / )5 L 9 3 . .
(8) Q (5) (2) JY Q ` A d:; . 9
. 4 7 O . X . JY Q 3 B -6 E 9
mL mgL
3

θ$ sinθ # NK i $ T
^ 0 J <:E " 9 T<C" "> 9 T<C" C / .2

3 2
BR C / 0 ?:E L M > / M> 9 ‰ ; X . > 9 T<C C . ; (7)
di t
L # $Ri t $ NK ω V t
M 9/ B .2 J R 9A 9 9 . :; _ L M
dt
-
(8)
T / 9 M> 9 2 J R 9 X . L M 9 T<C C . ;
T A 9 9 - X w L M e <Z T 96 . / 9 6 {? M -
. . :; aW C 9 X . L M 1
Direct Current (DC)
4 2
Takagi-Sugeno (TS) Back Electro-Motive Force (emf)

4
x/ t # f x, u
7
y t #x t
9 C M> 9 U 4 I. X . > ; 9 (9)
9u t ∈R x t ∈R
I. Xm
M. ZM S X .2 / 9. - C K( 9 9 T<C) >
C 9 51 ` 6
: . >r - 9 U A
9 9 zD t ... h 9 9 9 z t h 2 9 9 9 z2 t 4 : i 6 _
(7 ) Q ZM S J E R . . X . /
?
/ C ZM S f - f x, u
:C > 39

: 5 -9 hD 9
: k 9 /; Q
i # 1,2, … , r / 9 i ? X
Q W2 w Sz t TK x t
96 . > 9 c9 Z /> 6 _
u t #
Q W2 w Sz t T
: - >^
zD t ... M 9 9 9 z t M2 9 9 9 z2 t 4 : i ? 6 _
•E

(15)
# $Xh z t K x t : 5 - 9 MD 9 9 9
T;

W2
x/ t # A x t Bu t
7 ∋ i # 1,2, … , r
y t #Cx t
> .6 L U . A :; aW C 9 / (10)
6 DE @9 > [ .- 4 /> U /> @> / ; E :0 NO1 j # 1,2, … , p / > 9 M I 6
.[25] . /> A _ / :- / I. (w ZM S / ;J E) X :| / ; ~ Q p />
C ∈R M×>
B ∈R >×
A ∈R>×>
U A _ Q r # 2D
3 '2 4 101 2. '+/ ,*+ , 8'+E -2-3 . - Q
L- ; 1 (7 ) Q †V :. 46 :; / @9 / ; ~ { Q z2 t , z t , … , zD t A:k
/ ; 61 X . 9 X C Q Sinθ ZM S J E 7 O . (9) Q > . L M(1 S C/; ~
9 ZM S J E 9 . . 6 9 X C / Q 6 9 ZM S . - 6 9 (11) Q ^ 9 4
. 4 B ZM / ;X . > 9 [ .- 4 ; 2: z t # N z2 t z t … zD t O (11)
w X :| ~ 2 6 E 9 ZM S J E A / 9 /> E :0 zI t DE L 5 9 P I zI t K>
: - 4 ; / 9 A x t B u t ^ 9 ;X . > . - Q MI
z2 # Sinθ (16) . - 6 1 ZM X .
Q J R 9 0 (7 ) Q (16) Q / )5 L 9 3 L M ZM / ;X . > /> ` 9 A 9 9
: 4 7 O . (17) : 4 6 9 (12) Q J R 9 /> E :0
mL mgL Q W2 w Sz t TUA x t Bu t V
θ$ z # NK i $ T x/ t #
3 2 2 Q W2 w Sz t T
(17)

# X h Sz t TUA x t Bu t V
X . / J R ZM S J E 9 L 9 (12)
/ 9 / C ZM S f - A 9 9 . . g ~ 9 W2
4 w z2 ∈ [a2 , a ] J R 9 6 6 . _ 9 h2 y t #Cx t

. /> .U Q A /Y 9 6 a # l A 6 a2 # $ l
:6
w z t
. M . c _ K 9 h2 6 9 w] ; h Sz t T #
/ 4 9 Q W2 w Sz t T
D
z2 # a2 M2 a M # X aI MI
(13)
(18) w Sz t T # Z M I zI t
IW2
IW2
M. 3L /> ` / ;6> 5 9 M M2 6 :[25] . J F B9 _ 14 Q t6 >B / 9
⎧ X h Sz t T # 1
: f 5 9 (19) Q J R 9 . X :| ~
M2 Sz2 t T M Sz2 t T # 1 ⎪
⎪ W2

(19)
h Sz t T ≥ 0
for: i # 1,2, … , r ∎
Q J R 9 /> / ;6> (19) (18) JY Q > I. 9

(14)
⎪X w Sz t T > 0
⎪ W2
. . 9 (20)
z2 t $ a ⎪
M2 Sz2 t T #
m a2 $ a ⎩ w Sz t T ≥ 0
M Sz2 t T # 1 $ M2 z2 t
(20)
- ZM U [ .- 4 /> . ZM ( U :E > v
0 (21) Z9 (17) Q (18) Q / )5 L 9 ` k ; A > I. 9 4 7 O . ZM S X .
: ; 6 . 9 U 2 / 9 39
mL mgL
θ$ X aI MI # NK i $ T
3 2
(21) `. U 2 \. U Q ZM X .
IW2 @ > > .6 L / U X . A . : ;
9
[ .- 4 ; > 6 ZM S J E (21) Q
. ^ 1/>
h k i # 1,2, … , r > .
ZM S Q c _ J R 9 . -B ZM / ;X . >
C M> 9 ` k `
6 9B9 _ > /> X . > 9 Q A . : sR (7 )
: .
- 9 Š a9 h2 4 : 1 2 L
1
Parallel Distributed Compensation (PDC)
: 5

5
mL mgL
x/ t # X h Sz t Th Sz t TG x t θ$ M2 a2 # NK i $ T
3 2
(22)
h2
W2
GI GI

L M < . J9 U
(28)
2 X X h Sz t ThI Sz t T 7 Œx t
: 5 - 9 2V 4 :7- 2 L
2 mL mgL
θ$ M a # NK i $ T
3 2
W2 }I (23)
\ -6 (26) Q > 9 T<C / f - U :E 9
> .6 L / U > X .2 /> . 3L
. _ . 9 (28) Q / 9 /
s t
/> . ZM C / D 2 . - I . /> @>

6
- 9 1 < s ≤r
> : / 6 > B / 9 /> A _ Q 4 :5H
: 4 Q >J R 9 X . -
0 1 0
⎡3mgla2 ⎤

I. 9
$3K
: 5 / 4 9 -9
1 ⎢ 0 ⎥
X h Sz t T $ X X 2h Sz t ThISz t T ≥ 0 A2 # ⎢ 2mL mL ⎥
s$1 $NK $R
⎢ 0 ⎥

>
IW2 W2 }I
⎣ L L ⎦
0 1 0

U
:6
⎡3mgla ⎤ 0
(24)
$3K
X h Sz t T # 1, h Sz t T ≥ 0 ∎ ⎢ 0 ⎥ 0
A # ⎢ 2mL mL ⎥ B # u1v

...
W2
⎢ 0 $NK $R ⎥ L
⎣ L L ⎦
.[25] .
0 (28) . /> X . Q :7- NL (25) Q ^ 9 > .6 L U X . C M> 9
JY Q -9 L P AQ m v 4 . 4 : 4 7 O.
.[25] ‹ R (30) (29) u t # $ h2 k2 x h k x (25)
G~ P PG < 0 (29) / ; 39 C K A d:; / . 9 / <•
GI GI ~
GI GI
• € P P• € ≤ 0,
2 2
^ <Q ‚ 9 9 . A . 4 _ L U
i < j ∋ h ∩ hI ≠ ∅
(30)
T<C X . / /> / @ > > .6 L / ; 39 6 9
1 W >. / ; 39 C K / 9 - v8. - . 9 9
^ 9 { @9 / J F / 9 :( /O'
: 5 . - 4 w P>0 ‚ 9 V x t # x ~ t Px t . - ; M

V/Sx t T # X X h Sz t ThI Sz t T x ~ t
W2 IW2
3 4 3 ;5 3 ' 1 M1'+ -3-3
× „SA $ B K IT P PSA $ B K I T… x t
~
9 Xw U / ;X . { ; A :E
# X h Sz t T x ~ t [G~ P PG ]x t a / 6 E 9 / 5 X3 / <• . X ./;
W2 X3 { ; > 5 ;X . / . 4 _ L 9
X X 2h Sz t ThI Sz t Tx ~ t . :- 9 U / ;X . />C r K 6. 3
W2 }I
GI GI ~
GI GI
× †• € P P• €‡ x t
!. I -B O / . 2 / R
2 2 9 CA . 3 9 . > )4 4 / ;
6 9AQ I 4 0 / f- 9 L 9 / . 9 A 9 9. )6 X . e <Z / ;
:A 9 9 . V/Sx t T {
V/Sx t T < 0ˆx t ≠ 0, Then
/ . 9 3L .[24] . X3 2 X . ;
_ . 9 / \ - 9 /> @ > > .6 L
X h Sz t T x ~ t [G~ P PG ]x t . 4
W2
‚ 9 (12) Q . /> X . : 1 NL
X X 2h Sz t ThI Sz t Tx ~ t (31) AQ m !. 2 . 4 0 > u t #0
W2 }I
Gij Gji Gij Gji Pv
€ P P• €‹ x t < 0
T
× Š• ∎
/ 9 / 4 9 -9 - L (26) Q / 9
2 2 .[25] ‹ R ;X . > / :;
A~ P PA < 0 i # 1,2, … , r ∎
(30) (29) JY Q (31) / - I4 X 9 L 9 (26)
. . J F 9 D_ . 9 JY Q ` 9 T<C X . 2 / ‚ 9 UC
. - . ] (27) Q (15) (12)

x/ t # X X h Sz t ThI Sz t TxA $ B K I y x t
3 '2 4 101 2. ' 1 ,*+ , 8'+E -4-3
(27)
9c_ J R 9 ZM S X . 2 [ .- 4 ( W2 IW2

2 C KA 9 9 B ZM / ;X . > > 28 Q ^ 9 (27) Q G I # A $ B KI ‚ 9


T_ [ .- 4 ; > - \9 / 9 U . -7 O.

1
Lyapunov

6
/ 39 • U 9 U . 3L e <Z > g• 6 . . ZM S X .2 / 9 U C KU Q
49/ 4 `-‘ / 4 J -
I. Xm
5 C >c1 > > B _ PO9 /> X ./ \ - . 9> v
- > Q_ g“ J 9 j - w] 2 / > Q_ g’ -@ > > .6 L U / ; 39 - 7 O . / f -
/ 5 C > c 1 –1 B _ >/ < 2 2 / . - . ] />
G I # A $ B KI
:C > 39

/ 39 . . 6 1 / 5 C > c 1 –2 6 / <L (32)

J9 / - Q X w / ; < \. (•) / 4 J - - I . (32) (30) (29) JY Q > { ; A / 9


7 O. / ; 39 / 9 (34) (33) JY Q E :0
•E

C E. 92a 9 L 9 - X w 9 \.
`- a . - 0 9 J 9 A 9 5 ; :; A 1 9 9 . -
$XA~ $ A X XK ~ B~ B K X > 0
T;

C e - 9 f 9 J E?K ‘ / 4 (33)
$XA~ $ A X $ XA~I $ AI X XK ~I B ~
- _ M 6
B K I X XK ~ BI~ BI K X ≥ 0
`. -9 1 9 9 C E. V; Q A 9 ; (34)
- .] 9 J 9 5 ; :; 3L / >e -6 9 J E 5 -9 X>0 / K M #KX ‚ 9
. - . 4 / )5 L 34 33 / ; Q K # M X Ž2
/ 4 > 4 _ 9 (35) / Q f - > ^ ; $XA~ $ A X M~ B~ BM >0
. 9F^ . C 9 P; P a 6 9 c9 Z $XA $ A X $ XA~I $ AI X MI~ B~
~

6 A9/ <L :. 9 6 C ^5 ; Um 6 E 9 B MI M~ BI~ BI M ≥ 0 ∎

P / ΠP a <L 5 C 9 Pa 2 - U 39 ` k .] / 9 . 9 JY Q >
9 ; 39 A .[25] - I . /> @ > > .6 L /
\. J E?K A 9 . • 2 6 A9
MATLAB a ^ ١
ZM JY Q BC ( > I .
} C - . 9 4 . f - X :| X . >
_9 • f-
> PO9 A - ` k 9 L 9. - .]
` - `. / 4 > 9 . -
C 9 J9 2 9 P a (35) Q cK / 4 . 9/ \ -> M 4 7 . Y Q
> P; iE 9 — f - U
. - A :D U A / A 9 9 .
C 9 91 . / 4 9
. 4 J9 Q_ €IC iE 9 ™ f -
- 9 M J R 9J9 X 5 A . 9 (&,+8 & Q JR. 8'7) 5 T. 5 +1 -5-3
X :| X . > 2 2 ; / 9 . ; N O1 9 - )4 J9 A 9 P 9 C ^5 ; 9 L 9
2 ;/ 4 > BT J R 9 4 Q a0 ; 5 C > / Q „ ]R / )5 L 9 4 0 6 9 / DE
U : U. U 9 : 2 6 9 . 9 |M - J E?K 6 / < fT
T A { ; . ; ^ 0 `. / U :E 9 / 4 . : C K ; 5 C J E?K . 9 e <Z / X 5
J 9 / 9 /> @ > > .6 L X . <:E . 9 . / ; 5 C / 4 _ B] / ; 6 1 4 B -
\. - J E?K ‚ 9 -9 / 31 6 . 9 6 9 J9 A 9P / 4> / Ih
- J R /> . - A e <Z T 6 E 9 X :| X . >
. )

3 / 'V)' -4
J R 9 . : _ 9 /> . - a9 2 Simulink
-U . - 0 4 MATLAB a ^ BM O9 2
^0 <9 / ;^ 4 J R 9 O9 A / ;… <9 \. /> .
> 6 9 X .2 6 Simulink > I. 9. -
6 > I. 9 3 2 0 : B <] 6 A M . 9
FG . 9 9 6 > a; L R 9 ?E 7+ 3 ;+U 8 3 )+ -4 D
X . 2 <:E 9 / B E . J-1 S
B:Q v E )4 M Z - ;/> . - A . > 89 X :Q X . > 9 X C \9 <• A „ 1 3L
M - 9M 96 / /; ~ J R X .2 : - W (35) Q J R 96 \ -
s< O / ; - > / > / ; O9 / Simulink . - g• # • × ‘ g’ g“ ”•: –1 > 0 •
mg• # $ • × ‘ g’ g“ ”•: –2 > 0 —
g• # g“ ”•: –1 ≅ 0 ∩ –2 ≅ 0 ™
.[26] . D ; 2 ‹ 9 <:L > (35)
Simulink \ ] /> @ > > .6 L / U
; > I. 96 <:E ] 4 /> .U MATLAB 1
Linear matrix inequality (LMI)
. 4 _ . 9 [ .- 4 /> . ZM

7
\]
Simulink - ^ 0 /> .U / 9 5 B -
1 U L r - 9 6 s< O / ; C ; 6 1 MATLAB

L M < . J9 U
. . -6 9

H2 -3 / 3 ; 8'7 -1 *7

6
J]k X . >^

I. 9
- ZM ; 9f 9 X . > TS
[ .- 4 /> . Subsystem

>
2 1@ - K , . &4 ; M 2. [ J. -7 D @ > > .6 L / U PDC

U
/> Controller
- ZM X . 9 ZM S X . B /> . - !. A d:; e <Z !. A Q X . >

...
Desired
b A . - W 7B - : ; A 9 - /Ž> . (X :| X . >) Response

U c _ J R 9 [ .- 4 ; ; 61 3L w ZM S X .
Plant
. . : /> .U Q <R X . ZM S / U :E /> . ZM
- L M b P : X . > Output
U /; Monitor
-01 2. '+/ ,*+ , ) : 8] -2-5
3 '2 41
6 E 9 / [ - ^0 /; /> . -
w X . L M 6 E 9 J9 2 > /
U :E 9 > .6 L U . 9 3L . - 4
/ . U L M 9 IR S \ -2
9 T<C !. 7 B - : . - . 9 X . /> .
Simulink - 3 / 3 )+ -5 D
U . 31 ; 61 X .
/ 8B -. .9/ 9 X . L M
. ; 61 A / 9 3 / W1 -5
2 1@ - K , . 3 X% &4 ; &!# -1-5
> I. 9 > .6 L U 0 . ]R 3L
9 X . ZM S J E . - C K [ .- 4 ;
T 6 B - c K [ .- 4 ( 9 - /> . ZM U Q
. 4

H+ , 5 ) :8] -7 D

2 1@ - K , . &4 ; ) X%+ Z ( /> [ J. -6 D

H+ , 5 3-7 7 -8 D

8
I. Xm <• 9X C2 7 O . / 3 1 J9 Q > v ]R > .6 L U / > 6 :K > v
/> . ZM ; 9 /> @ > > .6 L U 6 . 3L U A [ .- 4 > . ZM C <:E
\] / 31 U - W [ .- 4 B - : > Z :; . - . 9 O 9 T<C !. 9
; - W b . 9 . - /> . - `< 2 : . e <Z !. J R 9 X . . 31 9
:C > 39

9 ZM S JY Q c _ J R 9 [ .- 4 /> . ZM . : / 5; 9 T<C
U A d:; . > A :O ZM / ;X . > ^ U \. - / [ 10 B -
•E

!. / 5; X . / €IC /> @ > > .6 L / 5; / . ; 61 9 U :E 3L


L M < . J9 2 U / 9 9 <Z <:E 9 T<C ( 24 m C) . [ ] 9 T<C !.
T;

/; 9 U :E 3L X .A 0 . : W . . - U :E
- / . `. / BT K 9 J9
T 9 X . / 9 T<C !. : e <Z / 4
. ; B w

;- -7
2
(Kg.m ) . 6: Jm
(Kg) ^ L m
(N.m) 1d 14 T
(m) U K L
QL ` k N H+ , 5 ) : 8] -9 D
(ohm) T R
(A) 6 L i
(mH) v Ls
(N.m/A) T ` k Km
(Rad) > θ
(Volt) B {? M V

0 '+ -8
[1] Govindu N.K., & Babski-Reeves K. Effects of personal,
psychosocial and occupational factors on low back pain
severity in workers. International Journal of Industrial H+ , 5 3-7 7 -10 D
Ergonomics, Vol. 44, 335-341, 2014.
[2] Shieh S.-H., Sung F.-C., Su C.-H., Tsai Y., and Chia-Rong
Hsieh V. Increased low back pain risk in nurses with high c K /> . - I. /; . } B9 _
workload for patient care: A questionnaire survey. . . - W 2U L
Taiwanese Journal of Obstetrics & Gynecology, Vol. 55,
525–529, 2016.
.^ • / _ • 9 .^ •- :C .^ / • O .j.^ • 9 • ] [3]
5•1 ••<0 .6 •. : 2[ . 9 .j 6 < <M
• 35 ]I•R (26 • ) 2 ‘ :- X I; U . B9 9 -a ^ <E 3 / 3 ;+ ' -2 *7
.1384 40 > >
[4] O’Sullivan L., Nugent R., and Van Der Vorm J. Standards
for the safety of exoskeletons used by industrial workers
performing manual handling activities: A contribution from
Jm 0/0008 R 1/ 2
the Robo-Mate project to their future development. m 2 Ls 0/05
Procedia Manufacturing, Vol. 3, 1418–1425, 2015.
-6 •9 / • Y 9 ^ T / 39 ZM S / U C K .j X [5]
Km 0/05 L 0/35
•- •. - • 6 .6 P a { ; 9 L M < . ( N 10 Vmax 24
.1393 6 - 51
[6] Tran H., Cheng H., Rui H., Lin X., Duong M., and Chen Q. 3+ K -6
Evaluation of a Fuzzy-Based Impedance Control Strategy
on a Powered Lower Exoskeleton. International Journal of 3L /> @ > > .6 L ( T A
Social Robotics, Vol. 8, 103-123, 2015.
[7] Lu R., Li Z., Su C.-Y., and Xue, A. Development and
. - W 6 / > L 3V L M < . J 9 2 9 U :E
Learning Control of a Human Limb With a Rehabilitation

9
51 J 1 (^ . P ) 6 U 9 / T . .r T [24] Exoskeleton. IEEE Transactions on Industrial Electronics,
Vol. 61, 3776-3785, 2014.
.1393 6 3 . K A | L M QR

L M < . J9 U
[8] Stopforth, R. Customizable Rehabilitation Lower Limb
[25] Tanaka K., and Wang H.O. Fuzzy Control Systems Design Exoskeleton System. International Journal of Advanced
and Analysis: A Linear Matrix Inequality Approach. John Robotic Systems, Vol. 9, NO. 4, 152-158, 2012.
Wiley & Sons incorporated, New York, 2001. [9] Sanz-Merodio D., Cestari M., Arevalo J.C., Carrillo X.A.,
[26] Kumar Tyagi A. MATLAB and Simulink for Engineers. and Garcia E. Generation and control of adaptive gaits in
Oxford University Press, London, 2012. ISBN: 978-0-19- lower-limb exoskeletons for motion assistance. Advanced
807244-7. Robotics, Vol. 28, 32-338, 2014.

6
[10] Cruciger O., Schildhaue T.A., Meindl R.C., Tegenthoff M.,

I. 9
Schwenkreis P., Citak M., & Aach M. Impact of locomotion
training with a neurologic controlled hybrid assistive limb
(HAL) exoskeleton on neuropathic pain and health related

>
quality of life (HRQoL) in chronic SCI: a case study.
Disability and Rehabilitation Assistive Technology, Vol. 11,

U
529-534, 2014.
[11] Agarwal P., Fox J., Yun Y., O’Malley M.-K., and

...
Deshpande A.D. An index finger exoskeleton with series
elastic actuation for rehabilitation: Design, control and
performance characterization. The International Journal of
Robotics Research, Vol. 34, 1747-1772, 2015.
[12] Chen B., Ma H., Qin L.-Y., Gao F., Chan K.-M., Law S.-
W., Qin L., and Liao W.-H. Recent developments and
challenges of lower extremity exoskeletons. Journal of
Orthopaedic Translation, Vol. 5, 26-37, 2016.
[13] Wu Q., Wang X., Du F., and Zhang X. Design and Control
of a Powered Hip Exoskeleton for Walking Assistance.
International Journal of Advanced Robotic Systems, Vol.
12, NO. 3, 18-28, 2014.
[14] Desbrosses K. Manual handling tasks performed with an
upper limbs exoskeleton at the workplace. Annals of
Physical and Rehabilitation Medicine, Vol. 60, 100-101,
2017.
[15] Hu J., Xu X., and Zhu K. Arm Exoskeleton Based on
Model Predictive Control with Input/Output Feedback
Linearization. Journal of Medical Imaging and Health
Informatics, Vol. 3, 432-439, 2013.
[16] Luna C.O., Rahman M.H., Archambault P., and Zhu W.-H.
Virtual decomposition control of an exoskeleton robot arm.
Robotica, Vol. 34, 1747-1772, 2014.
[17] Huang J., Huo W., Xu W., Mohammed S., and Amirat Y.
Control of Upper-Limb Power-Assist Exoskeleton Using a
Human-Robot Interface Based on Motion Intention
Recognition. IEEE Transactions on Automation Science and
Engineering, Vol. 12, 1257–1270, 2015.
[18] Garrido J., Yu W., and Li X. Modular design and control of
an upper limb exoskeleton. Journal of Mechanical Science
and Technology, Vol. 30, 2265–2271, 2016.
[19] Witkowski M., Cortese M., Cempini M., Mellinger J.,
Vitiello N., and Soekadar, S.R. Enhancing brain-machine
interface (BMI) control of a hand exoskeleton using
electrooculography (EOG). Journal of NeuroEngineering
and Rehabilitation, Vol. 11, 165–170, 2014.
[20] Leonardis D., Barsotti M., Loconsole C., Solazzi M.,
Troncossi M., Mazzotti C., Castelli V.P., Procopio C.,
Lamola G., Chisari C., Bergamasco M., and Frisoli A. An
EMG-Controlled Robotic Hand Exoskeleton for Bilateral
Rehabilitation. IEEE Transactions on Haptics, Vol. 8, 140–
151, 2015.
[21] Murray S.A., Ha K.H., Hartigan C., and Goldfarb M. An
Assistive Control Approach for a Lower-Limb Exoskeleton
to Facilitate Recovery of Walking Following Stroke. IEEE
Transactions on Neural Systems and Rehabilitation
Engineering, Vol. 23, 441-449, 2014.
[22] Anwar T., and Al Juamily A. Adaptive Trajectory Control
to Achieve Smooth Interaction Force in Robotic
Rehabilitation Device. Procedia Computer Science, Vol. 42,
160-167, 2014.
[23] Lee J.-W., Kim H., Jang J., and Park S. Virtual model
control of lower extremity exoskeleton for load carriage
inspired by human behavior. Auton Robot, Vol. 38, 211–
223, 2014.

10

You might also like