Professional Documents
Culture Documents
Ugraeni upravljaki sustav za AUTAREP- novu AUTonomnu Artikuliranu Robotiku Edukativnu Platformu
ISSN 1330-3651(Print), ISSN 1848-6339 (Online)
UDC/UDK [62-523:004.896]:378.147
Ugraeni upravljaki sustav za AUTAREP- novu AUTonomnu Artikuliranu Robotiku Edukativnu Platformu
Izvorni znanstveni lanak
U ovom se istraivanju predstavlja nova AUTonomna Artikulirana Robotika Edukativna Platforma (AUTAREP). Platforma je usmjerena na ruku s 6
stupnjeva slobode s viestrukom povratnom spregom za osiguranje tonosti i autonomije. Osjetilni se sustav sastoji od povratne sprege za vid, poloaj i
snagu dok pogonski sustav ukljuuje est preciznih DC servo motora. U radu je posebno prikazan nacrt ugraenog upravljaa za AUTAREP. Predloeni
nacrt upravljakog suelja hardwera i softwera izraen je prema akademskim potrebama relevantnih prijediplomskih i poslijediplomskih kolegija.
Komande nieg nivoa pruaju mogunost razvoja aplikacija za one koji se obuavaju. Napredni korisnici mogu dalje istraivati otvorene mogunosti
arhitekture platforme. Rad predloenog upravljakog sustava prikazan je razliitim eksperimentima na proizvedenom hardweru. Upravljanje je bilo
podvrgnuto razliitim vrstama ispitivanja u svrhu analiziranja ponaanja u prijelaznom i stacionarnom stanju. Robot je ispitivan kako bi se uspjeno
postigao zadani poloaj te su zabiljeeni podaci kodera koji odgovaraju svim zglobovima. Konano, provedena je uobiajena aplikacija "uzmi i postavi".
Predloena platforma moe biti korisna u nastavi tehnikih kolegija, obuavanju u industrijskom sektoru i istraivanju naprednih algoritama.
Kljune rijei: edukacijski robot, manipulator, projekt komandi, upravljanje robotom
Introduction
Embedded control system for AUTAREP - a novel AUTonomous Articulated Robotic Educational Platform
Kinematics
Physical
U. Iqbal et al.
Specs.
No. of joints
No. of DOF
Range of Motion
(ROM)
Locomotion
Actuation
Weight
Dimensions
Vision
Force
Position
Position precision
Position
repeatability
Performance
Movement speed
Payload
Action radius
Sensing
Description
5
6
Wrist pitch: 260
Wrist roll: 360
Elbow: 172
Shoulder: 90
Waist: 310
Articulated links
6 DC Servo motors
33 Kg
Base 220180(H) mm
Arm length
220+220 mm
Camera (Logitech)
FSR attached at Gripper
Optical encoders
1,5 mm
1 mm
100 mm/s (max.)
1 kg
580 mm (largest)
U. Iqbal i dr.
Ugraeni upravljaki sustav za AUTAREP- novu AUTonomnu Artikuliranu Robotiku Edukativnu Platformu
Symbol
1
1
1
0
0
L1
2
90
0
0
2 90
Joints (i)
3
4
0
0
L2
L3
0
0
1 5 234 + 1 5
1 5
= 1 5 234
234 5
0
where
1 5 234 + 1 5
1 5 234 + 1 5
234 5
0
= 2 2 + 3 23 + 4 234 ,
= 1 + 2 2 + 3 23 4 234 .
1 234
1 234
234
0
5
90
0
0
6
0
0
L4
0
1
1
,
Host PC
CN
Interrupt
UART1
Current Position
External
Interrupt
ADC
Unit
Optocoupler
4n35
Motor Driver
Current Sensing
Resistor
DC Servo Motor
Encoder
(1)
(2)
(3)
Teaching
Pendant
dsPIC33Fj256GP710A
(a)
(b)
(c)
Figure 4 Fabricated hardware (a) Top view (b) Front view (c) Side view
Embedded control system for AUTAREP - a novel AUTonomous Articulated Robotic Educational Platform
Input /Output
commands
Gain
commands
Motor read
commands
Category Command
GS
HR,m
PA,m
PW,m
RL
KA,m,d
KB,m,d
KC,m,d
RA,m
RB,m
IB,b
IP
IX
OB,b,s
OP,d
OR
OT,b,s
AC,m
GC
GO
HA
HG
HH
HL,m
HS
MA
MC
MI
MM,m
MS,m
PD,m,d
PR,m,d
Motor set commands
U. Iqbal et al.
Description
Read gripper status
Read soft home position
Read actual position
Read destination position
Read limit switches
Set proportional gain
Set differential gain
Set integral gain
Read Proportional gain
Read differential gain
Read input or switch bit
Read input port
Read switch port
Set output port
Set output port
Read output port
Toggle output bit
Clear motor actual position
Close gripper
Open gripper
Go to hard home position
Go to soft home position
Execute a hard home
Hard home on limit switch
Set soft home
Stop all motors
Start all motors coordinated
Start all motors independently
Stop single motor
Start single motor
Set motor destination position, absolute
Set motor destination position, relative
U. Iqbal i dr.
Ugraeni upravljaki sustav za AUTAREP- novu AUTonomnu Artikuliranu Robotiku Edukativnu Platformu
Experimental results
Embedded control system for AUTAREP - a novel AUTonomous Articulated Robotic Educational Platform
U. Iqbal et al.
T1
10
11
12
T2
13
14
Time (s)
T3
15
16
17
18
19
20
21
22
23
T4
24
25
26
27
T5
Figure 12 Encoder data of all the joints corresponding to pick and place task accomplishment
Conclusion
U. Iqbal i dr.
Ugraeni upravljaki sustav za AUTAREP- novu AUTonomnu Artikuliranu Robotiku Edukativnu Platformu
References
Authors addresses
Usama Iqbal, Ing.
Abdul Samad, Ing.
Zainab Nissa, Ing.
Jamshed Iqbal, Asst. Professor Dr. Ing.
Robotics & Control Research (RCR) Group,
Department of Electrical Engineering,
COMSATS Institute of Information Technology (CIIT),
Park Road, Chak Shahzad,
Islamabad, Pakistan
E-mail: jamshed.iqbal@comsats.edu.pk
1261