Professional Documents
Culture Documents
K hiu
ai
n v
m
di
Dq
e
JT
Mtf
i,j,n
O
pkt
Abstract:
Nowadays, robots are known as a supported tool very
effectively for people in the industrial activities,
business activities, medical or educational fields. By
understanding the mode of communication between
the robot arm RV-2AJ and computers through the use
of a haptic device - BambooPad, this paper presents
a new robot application towards the application of
robot to do the sketches. To implement the mode to
do the sketches, four specific phases were carried out:
i) Simulating robot RV-2AJ on Matlab software; ii)
Decoding information signals of RV-2AJ robot
through the use of Serial Port Monitor software to
collect instructions through RS232 port; iii)
Designing the robots control software by using
RS232 port and BambooPad; iv) Checking the
operation of the robot and designed software. As a
result, the robot can be able to stimulate the sketch on
a certaint plane within its reachable space.
Keywords: Doing the sketch by Robot arm RV-2AJ,
Haptic devices, Matlab software.
K hiu
VCCA-2015
ngha
Tham s ng hc Denavit
Hartenberg
Tham s ng hc Denavit
Hartenberg
Tham s ng hc Denavit
Hartenberg
Tham s ng hc Denavit
Hartenberg
Vector sai s
Vector 5 phn t tng ng
vi 5 khp ca robot
Ma trn jacobian c
chuyn v
Ma trn bin i thun nht
t h ta cng tc v h
ta gc
Vector n v ca trc x,y,z
t trn mt phng cng tc
Vector ta gc O trn mt
phng cng tc
Vector ta ca bt trn
touchpad
Vector trung gian
Vector ta cn t c
trong h ta gc Robot
Ch vit tt
PMAC
FMS
1. Phn m u
Mt cch t nhin, chng ta thng ngh ngay n
mt c my, hnh dng tng t con ngi v c
nhng hot ng tng t con ngi khi c ai
cp n ch robot. Nhng trn thc t, t robot
bao hm rng hn rt nhiu. Robot l tt c nhng
my in hay my c c kh nng thc hin mt
chui hnh ng phc tp mt cch t ng hay bn
t ng (Oxford Dictionaries, 2014).
Thut ng Robot c nhc n ln u tin trong
v kch Rossums Univesal Robot ca Karel Capek
nm 1922[1]. Nm 1961 robot cng nghip u tin
c ng dng trong nh my lp rp t ca
General Motor - USA [1]. T nm 1970 n nay c
H. 1
2. Ni dung chnh
2.1 S lc v robot RV-2AJ
VCCA-2015
H. 2
H. 3
S khi b tr cc th nghim
H. 4
trong hnh 3.
H. 5
VCCA-2015
H. 6
H. 7
H. 8
c thng s cc khp.
Theo yu cu ra, v vi s h tr ca Matlabguide, mi n v nt bm trn giao din hnh 8 s
thc hin mt chc nng chnh v kt hp mi mt s
chc nng khc:
Chc nng reset li s thc thi sau chc nng
dng robot.
Chc nng tr v v tr home s thc thi sau khi
khi ng robot.
Chc nng tng/gim v tr s i km vi vng
lp cp phn ng hc ngc tin
hnh m phng robot.
Chc nng c thng s khp thc thi trc khi
lnh di chuyn robot c gi i m bo ta
tip theo vn nm trong khng gian lm vic
ca robot.
Hnh 8 trnh by giao din iu khin robot o:
Hm ny c to ra vi 5 mc ch chnh:
Kt ni MATLAB vi cng truyn thng RS232.
iu khin khp c tay ca robot n v tr xc
nh trong khng gian.
ng kt ni vi cng RS232.
PressureTest_GraphicTablet.m
wPtr = Screen('OpenWindow', 0, 0, [0 0 30 30]); %To ra mt ca s kch thc 30x30 phc v
thu thp d liu
WinTabMex(0, wPtr); %Kch hot driver, kt ni vo ca s wPtr.
WinTabMex(2);
% Bt u ghi nhn v x l s liu.
pkt=WinTabMex(5); %Truy sut d liu theo phng thc FIFO
Return_Value=pkt; %Ghi d liu thu thp c vo bin tr v
while(~isempty(pkt)) %Vng lp loi b cc im tha ghi nhn c t tablet
pkt = WinTabMex(5);
if(~isempty(pkt))
VCCA-2015
(a)
(c)
(e)
H. 9
(b)
(a)
(b)
(c)
(d)
(d)
(f)
VCCA-2015
(f)
Dq = a JT e
(1)
Trong e l vector 5 phn t tng ng vi 5 khp
ca robot, Dq biu hin cho sai s gia v tr hin ti
v v tr mong mun robot t c, c chn rt
gn cc tiu ca e v JT l ma trn jacobian c
chuyn v [14].
VCCA-2015
H. 11
H ta t cho cc khp
di[m]
0.3
0
0
0
0
i[
]
0
-90
90
-90
0
2.3.2 Tnh ton ta tuyt i ca im v trn
h ta robot
Thut ton tnh ton ta cn di chuyn ca bt v
c m t trong lu hnh 12.
Start
Px=pkt(1)
Py=pkt(2)
Pz=pkt(3)
=Mtf x P
End
H. 12
ix
i
M tf y
iz
jx
jy
nx
ny
jz
0
nz
0
Ox
Oy
Oz
[3]
[4]
[5]
[6]
[7]
[8]
[9]
[10]
H. 13
[11]
3. Kt lun
T kt qu nghin cu phng thc giao tip gia
robot v my tnh thng qua vic s dng thit b
haptic BambooPad, nhm thit lp mt ng
dng iu khin robot mi theo hng nghin cu,
pht trin phc v cng tc o to v thc hnh, c
bit l vic ng dng robot v k ha. Kt qu ny
ch l mt bc khim tn trong cng cuc a thit
b k thut hin i vo thc t, nhng nhm tc gi
tin tng ti ny sn sng cng b th thu
hp khong cch ng dng tin b khoa hc vo thc
tin. t nn mng cho tinh thn nghin cu hc hi
v m rng ng dng cc thit b sn c trong mi
sinh vin Vit Nam. Kt qu nghin cu c th tip
tc k tha pht trin cc ng dng khc quan
trng hn, hiu qu hn, c li ch to ln hn nhm
phc v cho cng ng.
[2]
VCCA-2015
[12]
[13]
[14]
DigiMetrix
GmbH.
http://sine.ni.com/nips/cds/view/p/lang/en/nid/2
11070 Truy cp ngy 04/10/2014
Buitrago, J.A, 2011. Remote access lab for
Mitsubishi
RV-2AJ
robot.
http://ieeexplore.ieee.org/xpl/login.jsp?tp=&arn
umber=6086802&url=http%3A%2F%2Fieeexpl
ore.ieee.org%2Fiel5%2F6078719%2F6086789
%2F06086802.pdf%3Farnumber%3D6086802
Truy cp ngy 04/10/2014
Trng i Hc Cng Nghip TPHCM Gio
Trnh K Thut Robot Khoa Cng Ngh in,
TP.HCM, thng 12 2008
Samuel R.Buss, 2009. Introduction to Inverse
Kinematics
with
Jacobian
Transpose,
Pseudoinverse and Damped Least Squares
methods. University of California, San Diego La
Jolla.
VCCA-2015