Documente Academic
Documente Profesional
Documente Cultură
SISTEME DE CONDUCERE
CU MULTIPROCESOR
TERMINAL TABLOU
OPERATOR INSTRUIRE
MEMORIE INTERFAŢĂ
MICROPROCESOR
RAM-EPROM OPERATOR
INTERFAŢĂ MEMORIE
MAGNETICĂ
Figura 10.1
MAGISTRALĂ COMUNĂ
TERMINAL
OPERATOR
INTERTAŢA 1 INTERTAŢA 2 INTERTAŢA 3
TERMINAL
GRAFIC
Traducătoare Senzori deplasare Senzori deplasare
senzori forţă
MEMORIE
EXTERNĂ
Acţionare Acţionare Acţionare
terminal articulaţie articulaţie
Figura 10.2
qi q (iT ) q (t ) t iT i 0,1,2.......
(10.1)
u α (t)
q (t)
ROBOT
Figura 10.3
ei qdi qi (10.2)
ui G (ei ) (10.3)
u (t ) ui pentru iT t (i 1)T
(10.4)
Figura 10.4
f s 10 f b (10.5)
unde
1
fs
T
unde T fi sunt constantele de timp principale ale părţii fixe, sau [82],
T 0,5 min T fi
în care min { T fi } este cea mai mică constantă de timp a elementelor mecanice.
De asemenea, după [80] se propune
1 1
T .... T f pricipală
5 2,5
(10.7)
Toate aceste criterii mai mult sau mai puţin empirice permit alegerea unei
perioade de eşantionare T într-o primă etapă. Se impune ulterior verificarea
corectitudinii acestei selecţii printr-o analiză riguroasă a implicaţiilor introduse în
comportarea sistemului de conducere.
Plecând de la premisa că regulatorul şi elementele de comparaţie alanogică
sunt implementate corect sub raportul performanţelor prin controlerul numeric şi
blocurile de eşantionare şi de calcul al erorii (fig. 10.9.), diferenţierile între cele
două structuri de conducere, cea continuă şi cea discretă sunt date de blocul de
extrapolare. Se impune, deci, verificarea gradului de alterare al performanţelor prin
întârzierile introduse de extrapolare.
Figura 10.5
1 e sT
YEx s (10.8)
s
YR z Z YR s (10.9)
kf
Y1 z Z YEx s (10.10)
s s a
şi
e z Z e s (10.11)
q z Z q s
a1 a2 z 1 .... ak z k
YR z , kn
1 b1 z 1 .... bn z n (10.12)
359 Roboţi industriali
u z a1 a2 z 1 .... ak z k
e z 1 b1 z 1 .... bn z n
u z a1 a2 z 1 .... ak z k e z b1 z 1 .... bn z n u z
Figura 10.6
PROCESOR
u α (iT)
q α (iT) q (t)
CONVERTOR A/N ROBOT
Figura 10.7
10
Y f ( s)
s ( s 2.67)
(10.14)
E 0 (10.15)
E1 0.02 (10.16)
Lărgimea de bandă
f b 50 Hz (10.17)
( s 3.64)
YR ( s ) 252.3
( s 71.07)
(10.18)
361 Roboţi industriali
1
τf 0.37 s
2.67
1
T τ f 0.063s
5
1 e sT T 2 2
s sT 2 s 100
1 s
2 T
5064( s 3.64)
Y (s)
s ( s 71.07)(s 2.67)(S 100)
( s 3.64)
Y ( s )
s ( s 71.07)( s 2.67)( s 100)
( s a j )
YR ( z )
( s b j )
(10.19)
unde:
lim YR ( s)
k S O
limYR ( s)
S 1
(10.20)
1 z 1e 3.64T
YR ( z ) k
1 z 1e 71.07T
z 0.9297
YR ( z ) k
z 0.2414
3.64
252.3
k 71.07 139.42
1 0.9297
1 0.2414
Deci :
363 Roboţi industriali
z 0.9297
YR ( z ) 139.42 (10.21)
1 0.2414
sau
u( z) 1 0.9297 z 1
139.42
e( z ) 1 0.2414 z 1
M
(k=10000)
P3=-100 -38 Z1=-3,64 -3,64
6 6
P2=-71,07 P1=-2,67 P0=0 -71,07 -38 -2,67
N
(k=10000)
Capitolul 10. Sisteme de conducere cu multiprocesor
364
365 Roboţi industriali
Figura 10.8
1
wi ui
256
(10.23)
rezultă:
PROCESOR
q di
q di q im e i ECUAŢIA (10.24) wi x 256 u i EXPLORATOR
u i*
ROBOT
q i*
ECUAŢIA (10.24) q t
Figura 10.9
Fie deci {q i} mulţimea valorilor discrete ale răspunsului dorit, un semnal
treaptă. Cu aceste date se poate obţine transformata în Z a mărimii de ieşire.
q p 1 q p 2 ............... 1
qd*
t
*
q
T 2T 3T 4T 5T 6T 7T …………..
1
q3* q4* q5*
q2*
q1* t
T 2T 3T 4T 5T 6T 7T 8T 9T …………..
Figura 10.10
z ( p 1)
q( z 1 ) q 1 z 1 q 2 z 2 ..... q p z p
1 z 1
(10.26)
sau:
367 Roboţi industriali
1
qd ( z 1 )
1 z 1
(10.28)
este :
1
qd ( z 1 ) Y0 ( z 1 ) (10.29)
1 z 1
Y0 ( z 1 ) q 1 z 1 (q 2 q *1 ) z 2 ..... (1 q p ) z (11)
(10.30)
YR ( z 1 )Y f ( z 1 )
Y0 ( z 1 )
1 YR ( z 1 )Y f ( z 1 )
(10.31)
1
unde Y f ( z ) rezultă din figura (10.6) sub forma :
1 e Ts kf
Y f ( z 1 ) Z
s s( s a)
(10.32)
Capitolul 10. Sisteme de conducere cu multiprocesor 368
kf
Y f ( z 1 )
(1 z )(1 z 1e aT )
1
(10.33)
1
Întrucât Y f ( z ) nu conţine zerouri, există riscul introducerii unor
elemente instabile în circuit închis, deci YR ( z 1 ) se poate determina direct din
(10.31):
Y0 ( z 1 )
YR ( z 1 )
Y f ( z 1 )(1 Y0 ( z 1 ))
(10.34)
Primele două valori nule se datorează timpului mort apreciat la acest sistem:
2T
smax
q nCAN (10.35)
smin
deci
smax
nCAN log 2 (10.36)
smin
Capitolul 10. Sisteme de conducere cu multiprocesor 370
1
nCAN log 2 ;
0.01
6 nCAN 7
nCAN 7 1 8
2
1 LSB 7.812 mV
28
Iesire
digitala
0.1111111
Intrare
analogica 1 2
3,906 LSB 1V 1LSB 0.9922V
CS -1V2 Intrare
START CA 1
analogica
ST N 3,906mV LSB
t D7 D6 D0 2
c
1.0000000
Figura 10.11
371 Roboţi industriali
Intrare analogica
A15
Magist D
A0 rala P2
A0 CS
adrese
A1 START CONVERTOR A/N
MEMR P ST
A1 3
D7 D6 D0
UC A0
A1 P1
A0 P4
D7
D6
D5
D4
D3
D2
D1
D0
Figura 10.12
a z i
i
YR z i 0
n (10.37)
i bj z j
j 0
unde coeficientii ai, bj sunt mărimi cuantificate, exprimate într-un cod numeric.
Să presupunem că n biţi sunt utilizaţi pentru reprezentarea acestor
coeficienţi. În acest caz, utilizarea unui cuvânt de lungime impusă n poate
determina o reprezentare eronată. Fie
*
ai ai i (10.38)
b*i bi i (10.39)
* *
unde ai si bi desemnează valorile obţinute prin reprezentarea numerică în n biţi
a coeficienţilor reali ai, bi, respectiv iar αi, βi sunt erorile corespunzătoare.
Într-o reprezentare în complement faţă de doi, mărimea treptei de
discretizare numerică Δ corespunde valorii
2 n 1
i (10.40)
2
i
2
i 2n
deci (10.41)
i 2 n
a
*
i z i
YR z
* i 0
m (10.42)
1 b z *
j
j
j 0
Funcţia astfel obţinută diferă cantitativ de cea iniţială şi acest lucru poate
duce la modificări substanţiale în comportarea în frecvenţă a sistemului şi implicit
la schimbarea caracteristicilor de lucru . Pentru aprecierea, de exemplu, a efectelor
asupra stabilităţii sistemului se pot analiza modificările survenite în polii funcţiei
de transfer. În [32] se arată că polii pi se deplasează la pi pi conform relaţiei:
m
p ij 1
p i
(10.43)
j
pi
j i
1 p
i 1 r
m j
5 m m
n INTREG log 2 m 2 z r T (10.44)
2 r 1
z e 3,64T
YR z k
z e 71,07T
5
n INTREG - log 2 3 71,07.0,02) 3,6
2
wi c1u i 1 c 2 ei c3 ei 1
(10.45)
u i 256 wi (10.46)
C1 : DB 4H
C2 : DB 83H
C3 : DB 4AH
Relaţia (10.45) poate fi rescrisă pentru o implementare numerică sub forma:
W 2 P1 * U 1 P 2 * E 2 P3 * E1
(10.47)
U 1 : DB 00H
E1 : DB 00H
MULT MACRO P, U, Z
U: DW 2200H
P: DW 3000H
Z; DW 2000H
Se iniţializează registrele:
MOV B, U
MOV P, C1
MOV C, P
MVI D, 07H
START: MOV A, B; SE TESTEAZĂ BITUL CEL MAI PUTIN
RAR; SEMNIFICATIV AL LUI U
379 Roboţi industriali
MOV B, A;
MOV A, H
JNC ADR1;
ADD C; DACĂ ACEST BIT=1 SE ADUNĂ C
ADR1: RLC;
RRC; SE DEPLASEAZĂ LA DREAPTA CONŢINUTUL
RAR REGISTRELOR
MOV H, A;
MOV A, L; H SI L CONSIDERATE IN PRELUNGIRE SI
RAR RESPECTÂND REGULA DEPLASĂRII
MOV L, A BITUL DE SEMN
DCR D;
JNZ START;
MOV A, B; SE VERIFICĂ CONTINUTUL CONTOARULUI
RAR;
JNC FINAL; SE TESTEAZĂ BITUL CEL MAI SEMNIFICATIV
MOV A, H;
SUI U DACĂ B7=1 SE SCADE DIN ULTIMA
MOV H, A VALOARE NUMĂRUL U
FINAL: MOV Z, H;
MOV Z+1,H
END M
REZULTATUL ESTE STOCAT IN Z
realizată prin blocuri specializate CNA care genereaza la ieşire un semnal continuu
corespunzător ponderii coeficienţilor ce apar în expresia numerică prelucrată.
Domeniul tensiunii de ieşire este bipolar şi poate fi ales, în funcţie de o
mărime de referinţă aplicată Uref în gama ±2.5 V, ±5 V, ±10 V.
Cuplarea unui astfel de convertor la microprocesor este prezentată în figura
10.13.
Magistrala de date este cuplată pe intrarea convertorului, conversia fiind
realizată pe 8 biţi prin trunchierea celor 16 biţi rezidenţi în zonele Z, Z+1 de
memorie. Dacă se doreşte o conversie pe 16 biţi, cuplarea se realizează prin două
porturi şi prin utilizarea unui convertor de construcţie specială.
381 Roboţi industriali
MEMW
UC
CS CNA
U ref
u0
a
DATA
t
ts
CS tpw
t
U0
t
b
Figura 10.13
ADR
Acţionare element 1
CE
Figura 10.14
CNA: DW FFOAH
LDA Z
STA CNA
S0
Figura 10.15
10 D 56577 : S 56579
20 POKE S ,0
Magistrală de date
Linii
selecţie
Figura 10.16
PEEK 56832
POKE 56833.3
7654321 0 7654321 0
Cartela Cartela
de de
iesiri iesiri
binare binare
(56832) (56833)
Magistrala
Magistrala date interne
date interne
Selecţie Selecţie
Figura 10.17
Iesire
continuă
. . . . . .
7. 6 5 4 3 2 1 0
Cartela
Cartela pentru
pentru iesiri
intrari continue
continue 56835
56834
Magistrală Magistrală
date interna date
Selecţie Selecţie
Figura 10.18
POKE 56835.50
POKE 56835.200
U
P
T1
t p 1000t motor
ui R2
R1
ui R
U R3
Mc
T1 t
c
(a) (b)
Figura 10.19
255
P
1000T1
10 REM-ACCELERARE-
20 T = 1000* T1
30 P = 255/T
40 FOR UI = 0 TO 255 STEP P
50 POKE 56835,UI
60 NEXT UI
70 END
Capitolul 10. Sisteme de conducere cu multiprocesor 388
R
C
S D
L
L0
P0 P1 T
L1
V Th
M
Figura 10.20
240 END
Interfaţa de putere
3
B0 F0
B1 F1
0 1
B2 F2
B3 F3 2
Figura 10.21
START a b
Figura 10.22.a
Figura 10.22(b)
10 S=56579 : D=56577
20 DIM F(4)
30 FOR I=0 TO 3
40 READ F(I)
50 NEXT I
60 DATA 5,6,10,9
70 POKE S, 15
80 FOR I=0 TO 3
90 POKE D, F(I)
100 NEXT I
110 END
10 S=56579 : D=56577
20 DIM F(4)
30 FOR I=0 TO 3
40 READ F(I)
50 NEXT I
60 DATA 5,6,10,9
70 POKE S, 15
80 IF PEEK(D) AND 2↑6 THEN 80
90 DI=”DISTANŢA”
100 SENS=”SENS”
110 V=”VITEZA”
120 V=256-V
130 IF SENS=1 THEN W=-1: ROT=1: GO TO 150
140 IF SENS=0 THEN W=0 :ROT=-1
150 FOR I=1 TO DI
160 W=W+ROT
170 POKE D, F(W AND3)
180 FOR J=1 TO V:NEXT J
190 NEXT I
200 END
393 Roboţi industriali
+12V
+12V +12V
Mpp
F3
Q3
D0 T F2
Q2
SAA 1027
F1
Q1
D1 R
F0
Q0
+12V
Figura 10.24 (a)
Secv. Q0 Q1 Q 2 Q3
T1 1 0 0 1
T2 1 0 1 0
T3 0 1 1 0
T4 0 1 0 1
Figura 10.24.(b)
10 S=56579 : D=56577
20 POKE S, 3
30 DI = “DISTANŢA”
40 SENS = “SENS”
50 IF SENS=1 THEN R=2
Capitolul 10. Sisteme de conducere cu multiprocesor 396
Ls
B
C
y1 y2 Y
Lj
x1 A
x2 E
X
397 Roboţi industriali
Figura 10.25
x 2 x1 N1 impulsuri
y2 - y1 N 2 impulsuri
START a
Iniţializare
registre şi date Comandă X +
Citeşte buton
pornire 0
N1
0
BP
1
Anulare X +
Închide griper
Comadă Z + Comandă Z +
Citeşte Ls Citeşte Lg
0
Ls 0
Lg
1
Anulare Z +
Anulare Z +
Comandă Y +
Deschide griper
N2
STOP
a
Figura 10.26
V cicluri FOR:-NEXT-
V cicluri FOR:-NEXT
Figura 10.27.
În mod similar, prin instrucţiunile 140 – 190 este comandat motorul axei X
în sens pozitiv pe distanţa N1 .
20 U=”TENSIUNE NOMINALĂ”
30 POKE 56834,1
40 W = PEEK(56834)
50 POKE 56834,0
60 X = PEEK(56834)
70 IF X<W THEN POKE 56835,U
80 IF X>=W THEN POKE 56834,0
90 GO TO 30
Valoare
prescrisa W
μP 56834 56834
Figura 10.28
X W
Y 128
2
Într-adevăr, dacă X=W rezultă Y=128 deci 1,28 V după conversia A/N si 5V
după A1. Dacă X-W [0;255] se obţine o tensiune finală în gama [5;10V].
Dacă W>X, semnalul de comandă va fi
WX
Y 128
2
W
μP 56834 56834 A2
A1 +5V Mcc
uE[0,2,5 6V]
uE[010V]
Figura 10.29
90 POKE 56835,Y
100 GO TO 20