Professional Documents
Culture Documents
Bai Thi Nghiem A KRB
Bai Thi Nghiem A KRB
KHOA: IN IN T TU BIN
TI LIU HNG DN
THC HNH - TH NGHIM
TN HC PHN
: IU KHIN ROBOT
M HC PHN
: 13316
H O TO
: I HC CHNH QUY
HI PHNG, / 2009
Hi Phng, ngy//20..
NGI BIN SON
Gip sinh vin thc hnh c cc thao tc iu khin Robot Scobot ER9 thng qua
dng c Teach Pendant v phn mm iu khin Robot Scobase - Phn mm cung cp
cng c cn thit cho ngi s dng trong qu trnh vn hnh v lp trnh cho Robot
Gip sinh vin hiu su hn phn l thuyt iu khin Robot hc trn lp
- Gii thiu chung v thit b phng thc hnh th nghim:
Scorbot ER9: l loi robot dng cnh tay ngi, b phn thn c kh ca robot c ni
bng cc khp thng ng, c 5 khp quay. Vi bn kp c gn vo th robot c 6 bc
t do. Mi khp ca robot c iu khin bi mt ng c in mt chiu nam chm
vnh cu qua hp truyn ng bnh rng v dy cu roa
My tnh
Thit b Teach Pendant cho php thc hin iu khin robot c lp vi my tnh .
ngThi
3h
Tun th 6
Tun th 7
Tun th 8
Tun th 9
Tun th
10
Bi 1
Bi 2
Bi 3
Nhm Nhm Nhm Nhm Nhm Nhm Nhm Nhm Nhm Nhm Nhm Nhm
1
2
3
4
1
2
3
4
1
2
3
4
Tun th 11
Khp
Chc nng
ng c
Quay thn
2
3
4
5
Vai
Khuu
C tay
Quay c tay
2
3
4
5
ng c in mt chiu
Hp truyn ng
Dy curoa v puly
ng c cho h trc 4v 5
Encoder .
Cng tc c s .
* Encoder
V tr v chuyn ng ca mi trc Scorbot ER9 c o bi encoder quang in
c gn vo u trc ng c a tn hiu truyn ng c t cc trc v. Encoer bin
chuyn ng quay ca trc ng c thnh mt tn hiu s bng b iu khin. Encoder c
t trn ng c nh ch hnh sau
Scorbot ER9 s dng cng tc quang c s trn mi h trc nhn dng v tr gc,
hoc cc v tr c nh khc. Cng tc c s c t trn a ging nh cng tc ti hn v
mt ci c c gn trn u ra ca trc truyn ng. Trong sut qu trnh a v v tr gc,
cc bin khp ca robot c chuyn ng mi mt thi im. Mi mt trc c di chuyn
cho n khi c ct tia sng. Khi b thu sng trn mi h trc gi tn hiu ti b iu khin.
Ln u tin v tr m cng tc c s pht hin, ng c tip tc quay cho n khi encoder sinh
ra xung kim. Ti thi im chnh l v tr gc ca h trc. .
4.2. CONTROLLER B h thng iu khin robot
L thit b trung gian kt ni gia my tnh v robot thc hin vic iu khin robot.
Vic truyn thng gia my tnh v b iu khin thng qua cng COM hoc RS 232 cho php
chng trnh c vit trn PC iu khin ROBOT. Ngoi ra thng qua thit b teach
Pendant cho php thc hin iu khin robot c lp vi my tnh .
Ni chung b iu khin bao gm nhng phn t in vi h thng vi x l. Cc h
thng ny iu khin chuyn ng ca cc end effector thng qua vic iu khin chuyn
ng ca cc bin khp. Trong mt s trng hp c th lu tr cc chng trnh trong b nh
ca chng .
a. Thng tin tng quan b controler B
Cc c im ca b iu khin .
+ Loi iu khin: Bao gm iu khin c lp, thi gian thc, a nhim, PID ( T l ,
tch phn v vi phn ), PWM iu khin rng xung
+ iu khin ng: gm CP ( ng lin tc ), ng ni, ng thng, ng trn,
ng hnh sin, ng c nh ngha bi ngi s dng to ca thit b .
+ iu khin qu o: Bao gm iu khin qu o kiu Parabonoit, qu o ng
hnh sin.
+ Cc tham s iu khin: iu khin servo, tc , vn tc trt, sai lch v tr trc,
hot ng ca bn kp, bo v nhit, va chm, gii hn, dn ng, giao din encorder, v cc
php tnh .
Ngoi ra cn nhiu cc thng s khc nh: Cp ngun vi phn, trng lng kch thc,
di nhit hot ng, chp, b nh card vo ra ...
Hnh15: u ra ca b iu khin
- Truyn thng: Hai knh tch hp chun truyn thng RS 232 c th c m rng ti
10 knh .
- a nhim: Thc hin ng thi ti a 40 nhim v ca ngi s dng
5. Kt lun, cc yu cu cn t c i vi sinh vin sau khi thc hnh:
- Nm c cu trc tng quan ca con Robot Scobot ER9 trong phng th nghim
- Cc phng php iu khin Robot
- Phn mm Scobase-pro ngn ng lp trnh cho Robot Scobot ER9
Bi 2:
TNH TON NG HC CHO ROBOT SCOBOT-ER9
1. Mc tiu:
- Gip sinh vin hiu v nm r hn qu trnh tnh ton ng hc cho robot
- Trn c s l thuyt c hc, sinh vin lin h c vi vic tnh ton ng hc
robot trn thc t m c th y l Robot trn phng TN Scobot-ER9
2. Cng tc chun b ca sinh vin:
- SV phi n li tht k c s ton hc trong tnh ton ng hc robot
- Phi nm c c bn cc bc tnh ton ng hc ca robot
- Tnh c cc nh thc, t tnh ra c v tr ca bn kp robot Scobot-ER9.
3. Trang thit b cn thit:
- Scorbot ER9
- My tnh
- B iu khin Controller B
- Thit b Teach Pendant
4. Cc ni dung, quy trnh:
RH .
ox
oy
ax
ay
oz
0
az
0
px
py
pz
- Lp bng quan h DH
- Tnh Cc nh thc A1A2.....A5.
Ma trn tng qut :
Cos n
Sin
n
Sin n .Cos n
Cos n .Cos n
Sin nSin n
Cos n .Sin n
Sin n
0
Cos n
0
Ta c ma trn ca bn kp l :
anCos n
anSin n
dn
nx
n
y
R
0
0
1
4
TH = T5 = A 1 . A 2 ... A 5 =
nz
ox
ax
oy
ay
oz
0
az
0
px
p y
pz
Bi 3:
SCOBOT ER9 LM VIC TRONG K THUT HN
1. Mc tiu:
- Gip sinh vin thc hnh c cc thao tc iu khin Robot Scobot ER9 thng qua
dng c Teach Pendant v phn mm iu khin Robot Scobase - Phn mm cung cp cng c
cn thit cho ngi s dng trong qu trnh vn hnh v lp trnh cho Robot.
Khi ng my tnh
Sau khi np cc v tr mi xong, cho chy chng trnh bng cch vo menu Run.
+ Nu mun Robot chy theo tng dng lnh mt th chon Run Single line.
+ Nu mun Robot chy theo chu k th chn Run Single cycle
+ Nu mun Robot chy lin tc th chn Run Continuosly.
Sau khi robot hon thnh xong cng vic hn ca mnh, ta phi a robot v v tr
gc