II F 3-7
Fig. 3.7/2:
Software structure - Speed reference chain
50
.0
6
AC
W
B8
24
.1
3
24
.1
2
24
.2
0
24
.1
9
24
.1
8
24
.1
7
24
.1
0
24
.0
9
24
.0
6
24
.0
5
24
.0
4
24
.0
3
20
.0
6
20
.0
7
LO
C
A
L R
E
F1
+
23
.0
5
+
+
-
D
0
0
+
RE
F
1
AC
T1
98
.0
2
LO
C
A
L
M
O
TOR
SPEE
D
STA
R
T /
STO
P
CO
NT
RO
L
PUL
S
E
ENC
O
D
E
R
IN
T
E
R
F
A
C
E
K
P
S VAL
MA
X
S
P
E
E
D
KP
S
, T
IS
TI
S
V
A
L
MI
N
S
P
E
E
D
mo
to
r s
p
e
e
d
K
P
S T
IS
M
IN
S
P
EE
D
KP
S T
IS
M
A
X
S
P
E
E
D
W
INDO
W
S
P
E
E
D RE
FE
R
E
N
C
E
CHA
IN
SP
EE
D
C
O
N
T
R
O
L
6
3
(
(
'
0
(
$
6
8
5
(
0
(
1
7
DI
G
IT
A
L
IN
P
U
T
C
D
P3
12
or
DR
IVES
WI
N
D
O
W
LO
C
A
L C
T
R
L
PAN
E
L
SP
E
E
D
S
H
AR
E
MO
T
O
R
SPE
ED
FI
LT
SPE
ED
REF 2
6
3
(
(
'
$
&
78
$
/
SPE
ED R
E
F
3
SPE
ED
CO
RR
EC
TI
ON
6
3
(
(
'
(
5
5
2
5
1
(
*
DR
OO
P R
A
T
E
TO
RQ
AC
C CO
M
P
RE
F
2.
07
AC
CE
LER
A
T
IO
N
CO
M
PEN
SATI
O
N
A
CC
CO
M
P
D
E
R T
IM
E
A
CC
CO
M
P
F
IL
T
T
IM
E
24
.0
2
D
a
ta
s
e
ts
[7
0
.2
0
]+
0
.
.. [
7
0
.2
0
]+
1
4
MC
W
RE
F
2
MS
W
AC
T2
CO
MM MO
DU
L
E
CO
NS
T S
PEED
2
(I
N
C
H
IN
G
2
)
C
O
N
S
T
SPE
ED
1
(I
NC
HI
N
G
1
)
MC
W
B
8
, B
9
23
.0
3
23
.0
2
24
.1
4
24
.1
5
23
.1
0
SPEE
D STE
P
2.
0
3
P
ID
-
CONT
ROL
L
E
R
T
O
RQ
UE DER
RE
F
TO
RQUE
P
R
OP
RE
F
2.
06
2.
04
2.
09
LI
M
IT
E
R
S
P
C T
O
RQ
M
A
X
S
P
C T
O
RQ
M
IN
T
O
RQ
RE
F
2
TO
RQU
E
I
N
T
E
G REF
BA
L
RE
F
BAL
_
N
C
O
NT
SP
C T
O
RQ
M
A
X
KP
S
SP
C
T
O
R
Q
M
IN
KPS
KP
S MI
N
KPS
W
E
AKP
OI
N
T
KPS
W
P
F
IL
T
T
IME
TI
S
T
IS
I
N
IT
V
A
L
U
E
KP
S T
IS
M
IN
S
P
E
E
D
KP
S T
IS
M
A
X S
P
E
E
D
K
P
S
VA
L
M
IN
SP
EE
D
TI
S VA
L M
IN
SP
EE
D
DE
R
IV
A
T
IO
N
T
IM
E
DE
R
IV
. F
IL
T
T
IM
E
KP
S
TI
S
TO
R
Q
RE
F
2
M
C
W
B
x
=
M
A
IN
C
O
N
T
R
O
L W
O
R
D
(
7
.01)
AC
W
B
x
=
AUX
CO
NTR
O
L
W
O
RD (
7
.0
2
)
B
=
b
it
SPE
ED
E
R
ROR
F
IL
T
WI
N
D
OW I
N
T
G
O
N
WI
N
D
OW
WI
D
T
H
P
O
S
W
IND
O
W
W
IDT
H
NEG
23
.0
6
23
.0
7
23
.0
8
23
.0
9
(-
1
)
FI
L
T
E
R
23
.0
4
2.
0
2
2.
1
6
DV
/D
T
R
A
MP
BY
PA
SS
B
A
L
RA
M
P
RE
F
BA
L
R
A
M
P
O
U
T
V
A
R
IAB
L
E
SL
O
P
E
RA
T
E
VA
R
IAB
L
E
S
L
O
P
E
S
H
APE
T
IM
E
EM
E
ST
O
P
R
A
M
P
DE
C
E
L
E
R T
IM
E
A
CCE
L
E
R T
IM
E
2.
01
1.
04
1.
01
22
.0
1
22
.0
2
22
.0
3
22
.0
4
22
.0
5
22
.0
6
22
.0
7
AC
W
B3
22
.0
8
ACW
B2
MC
W
B5
FI
L
T
E
R
SP
AC
T
F
IL
T
T
IM
E
M
A
X
IMU
M S
P
E
E
D
MI
N
IMU
M
S
P
E
E
D
LI
M
IT
E
R
A
C
C/
D
E
C/
S
H
AP
E
MC
W B
4
MC
W B
6
20
.0
1
20
.0
2
50
.0
4
50
.0
3
50
.0
2
50
.0
1
re
se
rv
e
d
SP
EE
D
S
C
A
L
IN
G
S
P
EE
D
M
E
AS
MO
D
E
S
PEE
D
FB
SE
L
E
NCO
DER
P
U
L
S
E
N
R
50
.1
3
SP
A
C
T
F
T
C
ABB
D
R
IVE P
R
O
F
IL
C
O
N
T
R
O
L
MC
W
7
.0
1
M
A
IN
C
O
N
T
R
O
L
W
O
R
D
ON
OF
F
2
OF
F
3
RU
N
RA
M
P
_
O
U
T
_
Z
E
R
O
RA
M
P
_
H
O
L
D
RA
M
P
_
IN_
Z
E
R
O
R
E
SET
IN
C
H
IN
G
1
IN
C
H
IN
G
2
V
A
L
ID
_
CO
M
M
A
ND
B0
B1
B2
B3
B4
B5
B6
B7
B8
B9
B1
0
B1
1
B1
2
B1
3
B1
4
B1
5
EM
F
TAC
H
O
AI
1
1
2
3
4
7.
01
7.
0
2
8.
01
8.
0
2
DI
G
IT
A
L
OU
T
P
U
T
S
20
000 =
Sp
e
e
d
sc
a
lin
g
HO
L
D
RA
M
P
R
A
MP
T
IME
S
C
A
L
E
PI
FI
E
L
DB
U
S
ADA
P
T
E
R
FI
L
T
E
R
dcs_600\docu\fig_1.ds4
7.
03
8.
05
23
.1
2
RA
MP
E
D
I
N
CH R
E
F
23
.1
3
SPE
E
D
CO
R
R
RA
M
P
AN
I
N
1
VAL
U
E
AN
I
N
2
VAL
U
E
AN
I
N
3
VAL
U
E
AN
I
N
4
VAL
U
E
AN
IN
T
A
C
H
O
VAL
U
E
0
Sele
cto
r
13
.1
7
AI
S
P
E
E
D
SE
L
E
CT
ACW
B1
2
2.
1
9
S
P
E
E
D RE
F
1
2.
20
&
2
1
$
0
&
23
.0
1
6
3
(
(
'
5
(
)
7
.0
2
A
U
X
CO
NT
RO
L
W
O
RD
AC
W
B0
B1
B2
B3
B4
B5
B6
B7
B8
B9
B1
0
B1
1
B1
2
B1
3
B1
4
B1
5
RE
S
T
A
R
T
_
D
L
O
G
TR
IG
G_
L
O
G
G
E
R
R
A
M
P
_
BYP
ASS
BAL
_
R
AM
P_
O
U
T
D
Y
N
_
B
R
A
KE_
O
N
_
A
PC
H
O
LD
_NC
O
NT
WI
N
D
O
W
_
C
T
R
L
B
A
L
_
N
CO
NT
SYN
C
_
C
O
M
M
A
N
D
SYN
C
_
D
ISAB
L
E
RE
S
E
T
_
S
Y
N
C
_
R
D
Y
JO
G
_
R
E
F
DI
G
_
O
U
T
4
DI
G
_
O
U
T
5
DI
G
_
O
U
T
6
7
.0
3
A
U
X
C
O
NT
R
O
L
W
RD
2
AC
W
2
B0
B1
B2
B3
B4
B5
B6
B7
B8
B9
B1
0
B1
1
B1
2
B1
3
B1
4
B1
5
DI
G
_
O
U
T
_
7
DI
G
_
O
U
T
_
8
DR
IV
E
_
D
IR
SP
EED
_
E
X
T
MS
W
8
.0
1
M
A
IN
STAT
U
S
WO
R
D
B0
B1
B2
B3
B4
B5
B6
B7
B8
B9
B1
0
B1
1
B1
2
B1
3
B1
4
B1
5
RD
Y
O
N
RD
Y
R
UN
RD
Y
R
E
F
TR
IP
P
E
D
OF
F
_
2
_
S
T
A
OF
F
_
3
_
S
T
A
O
N
_
IN
H
IB
IT
AL
A
R
M
AT
_
SET
P
O
IN
T
RE
M
O
T
E
AB
O
VE_
L
IMI
T
8
.0
2
AU
X
STATU
S
W
O
R
D
AS
W
B0
B1
B2
B3
B4
B5
B6
B7
B8
B9
B1
0
B1
1
B1
2
B1
3
B1
4
B1
5
L
O
G
G
_
D
AT
A
_
R
E
AD
Y
OU
T_
OF
_
W
IN
D
O
W
E
M
E
R
G_
S
T
O
P
_
C
OA
S
T
ON
_
D
IS
A
B
L
E
D
SY
N
C
_
R
D
Y
FE
X
1
_
A
C
K
FE
X
2
_
A
C
K
LI
M
IT
IN
G
TO
R
Q
_
C
O
N
T
R
OL
Z
E
R
O
_
S
P
EED
FA
U
L
T
_
O
R
_
A
L
A
R
M
DR
IV
E
_
D
IR_A
S
W
A
U
T
O
_R
E
C
LO
S
IN
G
8
.0
5
D
I S
T
AT
U
S
W
O
R
D
D
I ST
AT
US
W
O
R
D
B0
B1
B2
B3
B4
B5
B6
B7
B8
B9
B1
0
B1
1
B1
2
B1
3
B1
4
B1
5
DI
1
CO
N
V
F
A
N A
C
K
DI
2
M
O
T
F
A
N
A
C
K
DI
3
M
A
IN
CO
NT
A
C
K
D
I4
pr
o
g
ra
m
m
abl
e
D
I5
pr
o
g
ra
m
m
abl
e
D
I6
pr
o
g
ra
m
m
abl
e
D
I7
pr
o
g
ra
m
m
abl
e
D
I8
pr
o
g
ra
m
m
abl
e
DI
9
DI
1
0
DI
1
1
DI
1
2
DI
1
3
DI
1
4
DI
1
5
LO
C
A
L
D
a
ta
s
e
ts
[7
0
.2
0
]+
1
.
.. [
7
0
.2
0
]+
1
5
2.
0
5
24
.1
1
SPE
E
D
RE
F
4
