viii
MỤC LỤC
TRANG
Trang ta
Quy tài
Lý lch cá nhân i
L ii
Cm t iii
Tóm tt iv
Mc lc v
Danh sách các ch vit tt vii
Danh sách các hình viii
Danh sách các bng x
Chng 1. TỔNG QUAN
1.1. Tng quan v robot 1
1.2. Các kt qu nghiên cc công b 3
1.3. M tài 7
1.4. Nhim v và gii hn c tài 7
1.5. u 8
Chng 2. C SỞ LÝ THUYẾT
2.1. Khâu, khp, b 9
2.2. Các dng bài toán robot 10
2.3. Truyn u khin robot 17
2.4. Lý thuyt chuyng ca khp gi 23
Chng 3.CÁC VN ĐỀ CẦN PHÁT TRIỂN VÀ KẾT QU CHẾ TO
3.1. V nghiên cu 24
3.2. Thit k cm bin momen 26
3.3. Thit k u chu lc cho khp gi 29
3.4. u 44
3.5. Tính toán công sut 47
ix
3.6. Thit k chi tit 48
Chng 4. VẬN HÀNH THỬ NGHIM C CU
4.1. u khiu 59
4.2. H thu khin 60
4.3. Vn hành và th nghiu 60
Chng 5. KẾT LUẬN VÀ KIẾN NGHỊ
5.1. Kt lun 65
5.2. Kin ngh 66
TÀI LIU THAM KHO
PHỤ LỤC
x
DANH SÁCH CÁC CH VIẾT TT
1. Btd: Bc t do
2. Btdtt: Bc t do th ng
3. Ctm: Chi tit máy
4. Cbl: Cm bin lc
xi
DANH SÁCH CÁC HÌNH
HÌNH TRANG
Hình 1.1. c vt nng 1
Hình 1.2.Mt s công vic phi mang vác vt nng 2
Hình 1.3.Các ng hp gp v v khp gi 3
Hình 1.4.u g gp 4
Hình 1.5.Góc vng ca khp gi 6
Hình 1.6. 6
Hình 1.7.Robot 7
Hình 1.8.AL 8
Hình 1.9.K 9
Hình 1.10.Honda_Walking_Assist_Device 10
Hình 1.11. 10
Hình 1.12. 11
Hình 2.1. 17
Hình 2.2.ncorder 20
Hình 2.3. nguyên lý ca loadcell 21
Hình 2.4.Nguyên lý làm vic ca loadcell chu un. 22
Hình 3.1. u 2 khp lch tâm 22
Hình 3.2. bin dng ca lò xo 24
Hình 3.3.Cm bin momen 25
Hình 3.5.Kt qu th nghim cm biu 26
Hình 3.6. Ly khuôn chân bng thch cao 30
Hình 3.7.u bng bê tông 34
Hình 3.8.Phn ng ni ngang ca phân t UPE 31
Hình 3.9.Chi tit ghép nc to hình bng compsite 32
Hình 3.10. 33
Hình 3.11.S bc t do th ng ca u có 1 khp. 34
xii
Hình 3.12.S bc t do th ng cu có 2 khp 35
Hình 3.13.S bc t do th ng cu có 3 khp. 36
Hình 3.14.Kt qu th nghim ln 1. 37
Hình 3.15.Kt qu ch to th nghim ln 2 38
Hình 3.16.Kt qu th nghim ln 3 39
Hình 3.20.Các bc t do th c b trí trên h trc t Decac 40
Hình 3.21.Momen cn sinh ra trên các bc t do th ng 41
Hình 3.22.B trí cm bin momen 41
Hình 3.23.Chu k c 42
Hình 3.24.Mô hình hóa các btd th ng khp c chân 45
Hình 3.25.Mô hình hóa các btd th ng khp gi 46
Hình 3.26.Mô hình hóa các btd th ng khp háng 46
Hình 3.27.Trng tâm c ng lên 47
Hình 3.28.Trng tâm c 48
Hình 3.29.Kht 49
Hình 3.30.Khp xoay 50
Hình 3.31.Giá lp motor 51
Hình 3.32.Các thông s ct t bi 52
Hình 3.33. ng chu ti ct t bi 53
Hình 3.34.Cu to chi tit cu 55
Hình 3.35.Kt qu ch to thit b h tr khp gi 58
Hình 4.1. nguyên u khin (b u khi 58
Hình 4.2.S a chu k ng thái ca khp gi 59
Hình 4.3.u khin theo các pha ca 60
Hình 4.4.V trí các cm bin trên bàn chân 61
Hình 4.5. nguyên lý mch u khin 62
Hình 4.6. nguyên lý mch cu H 62
Hình 4.7. nguyên lý mch khui 63
Hình 4.8 nguyên lý mch ngun 63
Hình 4.9. nguyên lý các nút nhu khin 63
Hình 4.10.Vn hành thit b h tr lc 64
xiii
DANH SÁCH CÁC BNG
BNG TRANG
Bng 2.1: Phân bit gia h tr lc và nâng vt nng 8
Bng 3.1:Mi liên h gia trng thái khp gi vm tip xúc trên bàn chân 24
Bng 3.2:Các ký hiu, thông s ct t bi 24
Bng 3.3: Thông s ti trng ca thanh t t bi 24
Bng 3.4: Thông s ti trng ca khp cu 24
Bng 4.1. Thut toán 4 Switch 61
1
Chng 1
TỔNG QUAN
1.1. Tng quan v các thit b b xng ngoƠi hỗ tr lực
1.1.1. Hỗ tr lực cho khp gối
Vì sao phi hỗ tr lực cho khp gối?
mang vác vt nng và di chuyn, trng ca vt phân phi lên kh
tha phi chu trng ca vt và tr ng thi
m nhim ch chuyn.H vng ca chân làm vic v nhiu
nht khi ta mang vác vt nng.
Theo các nghiên cu v mang vt nng trong an toàn v ng
cho thy khi nhc vt np gi làm vic nhiu nht:
Hình 1.1 c vt nng
(2)
(2) Ngun: Http://www.suckhoe.vn.
2
Hỗ tr lực là gì?
H tr lc là cung cp lc ( momen) cho các kh u ti
ho di chuyn ca các kh. H tr lc có hai loi:
Chu ti thay cho kh nâng vt nng
Truyn momen (lc) cho kh u ti ca khp
Bng 1.1 Phân bit gia h tr lc và nâng vt nng
H tr lc
Nâng vt nng
Khái nim
Cung cp momen (lc) cho các
kh h tr hoc cn tr chuyn
ng ca khp
Ti trng ca vt nng
t lên thit b
khí
Tính cht
Truyn momen ( lc) lên các khp
sinh hc
Truyn momen ( lc)
lên các khp c
c
ng dng
Phc hi cht b tp
luyn nâng cao sc b
Các thit b h tr
mang vt nng, b
lc.
1.1.2. Các ng dng, phân loi hỗ tr lực
ng dng h tr li s dng mang vác vt nng
3
Hình 1.2 Các các công vic phi mang vác nng
ng dng h tr khp trong phc hi ch p cho các bnh nhân:
o Có v v h p, cng khi bnh không th thc
hii sng hng ngày
o Cng vng cho các bnh nhân cn phc hi hu phu thut (v
h p) Bài tp h tr lc (thit b cung cp mô-men, lc cho khp),
hoc bài tng sc mnh cho h t b cung cp mô-men, lc
nhm cn tr chuyng ca khp).
o i ln tui, khp chân b yu, viêm kh
Hình 1.3 ng hp gp v khp gi
4
1.1.3. Gii thiu khp gối - Biên đ và tm vn đng cho khp gối.
Hình 1.4
thành 3 chày và bánh chè.
- mâm chày có trúc là chêm
chêm và mâm chày có tác xóc khi
và mâm chày xúc khi và cho
dây bên trong, bên ngoài và hai dây chéo và chéo
sau cho chéo có tác chính là
không cho mâm chày ra và dây chéo sau cho mâm chày không
ra sau.Dây bên ngoài giúp không trong, dây bên trong
giúp cho không ra ngoài.Toàn bao màng
có tác ra bôi trong quá trình
Gii phu khp gối: là hai
chày
trên chày: là hai trên xúc hai
5
sau bánh chè: ngoài và trong ròng
chêm: có hai chêm hai và chày là
chêm trong hình C và chêm ngoài hình O; hai này là mô
trên hai trên chày không các
và làm các va khi hai chêm nhau dây
ngang hai bám vào các gian chày; ngoài
dày, phía trung tâm và vòng c; chêm có ý
trong các tác nó di ra sau khi chân và di ra
khi chân.
Biên đ và tm vn đng ca khp gối:
- có hai - và xoay tác xoay là
và khi
- - là chính Biên -
khi chân theo và khi là 0
0
có
-5
0
biên thay theo háng,
140
0
khi háng 120
0
khi háng 160
0
và cho phép gót
mông)
- Xoay khi là 40
0
xoay ngoài và 30
0
xoay trong.
6
Hình 1.5
- g là - Trên
ta coi, 64
0
lên thang gác, 85
0
thang,
(theo pháp Zero) là 135
0
là 0
0
và là 135
0
) [9]
Hình 1.6 Góc khi lên và thang
Các c tham gia chi phối tm vn đng khp gối
-
7
ngoài. Ngo
-
1.2. Các kt qu ngiên cu đƣ đc công bố
1.2.1. Các kt quđƣ đc công bố nc ngoài
Hin nay trên các qu, Nht, Hàn Quu
cng hin v c các thit b h tr (b
1.2.1.1. B xng ngoƠiRaytheon Sarcos
Hình 1.7 Robot
, n
kh
ng
mang
8
1.2.1.2. B xng ngoƠihỗ tr chơn HAL
Hình 1.8 AL
h
1.2.1.3. B xng ngoƠiHULC (Human Universal Load Carrier)
9
Hình 1.9 K HULC
.
38kg.
1.2.1.4. Thit b tr giúp chuyn đng ca Honda
10
Hình 1.10 Honda_Walking_Assist_Device
1.2.1.5. B xng ngoƠi MIT
Hình 1.11
khung robot khác, v
11
1.2.1.6. B xng ngoƠi đẳng tĩnh cho khp gối nhơn to
Hình 1.12
ng) cho
1.3. Mc đích ca đ tài
Thit lp mt nguyên lý thit k c thit k thit b b
i. tài này, tác gi p tc phát trin nguyên lý thit k b
p sinh hc trình bày trong lua
(Cai, 2011). Nguyên lý thit k mc thit lp cho mt thit b hong cùng
lúc vi nhiu khp sinh hc khác nhau. Mng ti là tách ri, phân bit các
la mi khp sinh hu, khin viu khin tng
khp riêng r tr nên d n hóa thuu khin thit b,
cho phép bo nh ca h thng khi vn hành trong thc t.
Các ng dng ti
12
Nghiên cu và ch to th nghim thit b h tr cho khp g
vkhng vt mang, t di chuyn).
H tr cho nhi làm các công vic phi mang vác vt nng trong thi gian
dài, u kin làm vic mà máy móc không th thay th c, chng h
Binh lính phi mang khng quân trang khá l hàng chc km
mi ngày, công nhân trong các nhà máy l
H tr di chuyn cho nhi có khp gi b yu.
1.4. Nhim v ca đ tài và gii hn đ tài
1.4.1. Nhim v ca đ tài
Phân tích chng ca chân. Tìm hiu kt cu sinh hc, kh n
ng ho
Nghiên cu, tìm hiu phù hp vi khp gu có các bc t do,
các góc quay phù hp vi chân.
Tính toán, b trí các bc t do th ng.
n kt nu vi khp gi, la chc dng.
La chu khin, hi tip tín hiu.
Ch to mô hình th nghi thc.
1.4.2. Gii hn ca đ tài
Phn ln ch thit k ch to phn cng.
Ch khp gi.
Th nghim mt s chn ca thit b, nhng ti các ng dng
trong các bài tp phc hi chp gi.
1.5. Phng pháp nghiên cu
ng vi các mc tiêu nghiên cu phù hp
Tìm hiu tài liu
Nghiên cu, thit k
Tìm hiu, la chn
13
Ch to, th nghim
Chng 2
C SỞ LÝ THUYẾT
2.1. Khâu, khp, bc t do
2.1.1. Khâu
Làmt hay nhiu chi tit máy lp cht vi nhau thành mt vt cng; có chuyn
i vi cácvt cngkhác.
2.1.2. Khp
Bc t do: kh n c lp.
Ràng buc: bc t do b trit tiêu do 2 khâu luôn tip xúc nhau theo mt cách nào
Thành phnkhng: phn b mt tip xúc thuc v mi khâu khi phát sinh ràng
buc.
Khng: 2 thành phn khng cu 2 khâu tip xúc to ràng buc.
Phân loi khng:
- Phân loi theo s ràng buc to ra: khp loi k có k ràng buc.
- Phân loi theo b mt tip xúc: khp cao ting;
khp thp tip xúc theo mt.
2.1.3. Bc t do c cu
Vi:
14
o n: s ng;
o p
k
: s khp lai k(có k ràng buc);
o r
th
: s ràng buc tha;
o r
tr
: s ràng buc trùng;
o w
th
: s bc t do tha.
C cu phẳng
W = 3.n - ( p
4
+ 2.p
5
- r
th
) ậ w
th
Vi:
o n: s ng;
o p
4
vàp p
5
: s khp lai 4 (có1 ràng buc phng) và s khp lai 5 (có 2
ràng buc phng );
o r
th
: s ràng buc tha;
o w
th
: s bc t do tha.
2.2. Các dng bài toán robot
2.2.1. Các phép bin đi
,
Ta có : v = H.u
2.2.1.1. Phép bin đi tnh tin (Translation)
Gi u lu dim cn tnh tin :
u = [x y z w]
T
15
v = Trans(a,b,c) u
2.2.1.2. Phép quay (Rotation) quanh các trc to đ
góc quay góc
o
2.2.1.3. Phép quay tng quát
à
o
16
2.2.1.6. Bin đi h to đ vƠ mối quan h gia các h to đ bin đi
Phép bin đi tnh tin
h =4i -3j+7k (hình 2.12) .Kt qu ca phép bii là:
Phép bin đi quay
T
0
ng h), ta có :
T
0
, Ta có :
17
phép
2.2.2. BƠi toán đng học
Bng thông số Denavit-Hartenbert ca tay máy:
18
Hình 2.1 Các thông s
2.3. Truyn đng và điu khin robot
2.3.1. Điu khin t l sai lch (PE : Propotional Error)
ε = θ
d
- θ(t)
d
d
zero.
Nmomen ε= θd ậθ
F = Kp(θd - θ(t))
2.3.2.Điu khin t l - đo hƠm (PD : Propotional Derivative):
có t-
19
-
d
-
- .
Ke-
Kd-
2.3.4. Thit b cm bin
2.3.4.1. Cm bin góc quay ậ encoder
Hình 2.2ncorder xung
nIncremental encoderi v
trí góc quay, s xung sinh ra cho bit khong dch chuyn so vi v trí ban
u.Loi Absolute encoder, có bin nh v ch chuyn, k c khi mn cp
ngun (hay dùng trong các h thng có s dch chuyn hu hi cn bit v
trí tuyn cu, máy CNC v.v.)
2.3.4.2. Loadcell (cm bin lực)
S lc v loadcell
Loadcell là b chuyi t trng ng hoc phn lu
n. Cu tn ca 1 loadcell bao gm mt mnh hi, strain
gauges (cm bin dt ti 4 v trí ca thanh kim loi
b bin di.