Académique Documents
Professionnel Documents
Culture Documents
+ e uf + u iq* vq vβ
rfy
SVPWM
PWM3
PWM4
3-Phase
inverter
V
Inference KI Kv d, q
d,q α, β vrfz PWM5 W
_ ∆e FI Mechanism
DFI
1 − Z −1 +
PI PWM6
PMLSM
1 − Z −1 + −
- id iα i iu
α,
α,ββ a, b, c a
xp Knowledge
KP ib Current
A/D LPF
iq iβ α, β ic detector iw
Base d, q
d,q A/D LPF
+ − +
Park Clarke A , A ,B
θe π xp − + −
B ,Z ,Z
Adjust A
1-z-1 Sin&Cos Encoder
B
Differ-
Mechanism τ detector &
Z
ential
Transform. Circuit
em
_
xm + xp
0 xi ≤ xim − wim / 2 + Bk v u I ( k − 2) + Bk v ( K I + K p )u f ( k − 1)
xi − xim + wim / 2 wm (13) with A = exp(−BmT / M m ) , B = Kt (1− A) / Bm .
xim − i < xi < xim
2
wm / 2
ξ m ( xi , xim , wim ) = m i m
xi + wi / 2 − xi
when m wim Furthermore, according to the chain rule, the partial
x < xi < xi +
m
wim / 2
i
2 differential equation of J ( k + 1) in (16) can be
wm
0 xi ≥ xim + i rewritten as
2
∂J ( k + 1) ∂x ( k + 1) ∂u f (k ) (22)
where xi is input value, ξ m (•) is output value, xim and = −αe (k + 1) p
m
∂c j ( k ) ∂u f ( k ) ∂c j (k )
w im are mean value and width of the triangular where α is learning rate. From (21), (15), (22) and (17),
membership function. it is straightforward that the parameters c j of fuzzy
Derive M fuzzy control rules as initial condition,
such as, controller in (15) can be derived by the following
IF e is A1m and ∆e is Am2 THEN u f is Em ,m=1,2,..,M (14)
expression.
µj
Construct the fuzzy system with u f ( x | θ) from those ∆c j ( k ) = αBK v ( K p + K I ) e m (k )
∑µ m (23)
M rules using the singleton fuzzifier, product- m
CLK-ctrl
A[22]
Frequency
Nios Embedded Processor IP I-U[11..0] Application IP CLK-sys CLK
CLK-sp divider
A[0] CPU UART I-W[11..0]
D[31] ADIN[11]
Avalon Bus
Avalon Bus
ID[11..0]=‘0’
CLK-sys PI PWM-2
SVPWM
PWM-f[11..0]
ID[11..0] PWM-3
IDD[11..0] Controller VA[11..0] PWM-4
KP-p[11..0] VB[11..0] PWM-5
Servo on VC[11..0] PWM-6
KI-q[11..0]
CLK-ctrl
IQ[11..0] CLK-sys
IQ[11..0] PI
IQQ[11..0]
KP-q[11..0]
Controller VDD[11..0]
VQQ[11..0] CLK-sys
QEP[15..0] Servo on CLK-sys Modified VA[11..0]
rotor-position[15..0]
INV PARK
VAA[11..0] VB[11..0]
CLK-sys
VBB[11..0]
INV CLARK VC[11..0]
CLK-sp
CLK-sys
SIN/COS
QEP[15..0]
Encoder-A
EN-A
QEP EN-Z Estimation
EN-B
Encoder-B
Encoder-Z
EN-Z
of Flux
Flux-angle[11..0]
CLK-sys angle IQQ[11..0]
CLK-sys
CLK-sp
IDD[11..0] PARK IAA[11..0]
CLARK I-W[11..0]
IBB[11..0]
CLK-sys I-U[11..0]
Position (mm)
Read QEP from current Calculation of q-axis
Initial interrupt
vector control IP and current command and
4
calculate velocity of Send to current vector
control IP
2
PMLSM
Initial timer
0
Calculation of Calculation of error Response
Initial all position error and Between position of -2
peripherals the change of error motor and output of 0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
reference model (a) Time (s)
Setting of Calculation of output
position command of Fuzzy controller Parameters adjusting
8
of fuzzy controller
Command Pay load = 3Kg
Position (mm)
6
Calculation of
loop
speed loop End 4
2
Fig. 3 Flow chart of main and ISR program in Nios processor
0
PI Controller
Response
-2
CK
0 0.2 0.4 0.6 0.8 1 1.2 1.4 1.6 1.8 2
D-Type
Ki
CK
FF
Ui(k-1)
+/-
(b) Time (s)
Adder Ui(k)
CK
D-Type
Multi
saturate
Fig. 8 Position step position using FC under (a) without
CK
CMD
+/-
e(k)
FF
e(k-1) payload (b) 3 Kg payload
FBK Sub
saturate CK
U(k)
Up(k) +/-
Kp Multi Adder
saturate
6
vα va 4
1/2 2‘S COMPLEMENT
2
1/2
0
1/4
-2
0 0.5 1 1.5 2 2.5 3 3.5
1/16 adder vb (a) Time (s)
1/32
vβ adder 8
1/64 Command With Adaptation
6
Position (mm)
1/256
adder 2‘S COMPLEMENT vc
4
1/512
2
1/2048
0
Response
Fig. 5 The designed circuit of Clarke −1 formulation -2
0 0.5 1 1.5 2 2.5 3 3.5
(b) Time (s)
cosθe 12 bits
Fig. 9 Position step response under (a) 3 Kg payload and
multiplier using FC only (b) 3 Kg payload and using the
vd 12 bits vα proposed AFC
adder
− sin θ e 12 bits
vq multiplier
8
Command Response Without Adaptation
sin θ e
Position (mm)
12 bits 6
vd multiplier 4
12 bits
2
cos θ e 12 bits
adder vβ
0
multiplier
vq -2
0 0.5 1 1.5 2 2.5 3 3.5
Fig. 6 The designed circuit of Park −1 formulation (a) Time (s)
8
Generation of Command With Adaptation
Position (mm)
10
5
[1]F. Gieras and Z.J. Piech, Linear synchronous motors –
transportation and automation systems, CRC Press,
0 2000.
Response
-5
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 [2]P.K. Budig, “The application of linear motors,” in
(a) Time (s) Proceedings of the 3rd international of PIEMC, 2000,
4
vol. 3, pp.1336-1340.
2
error (mm)
0
[3]T.H. Liu, Y.C. Lee and Y.H. Chang, “Adaptive
controller design for a linear motor control system,”
-2
IEEE Trans. on Aerospace and Electronics System,
-4 April 2004, vol. 40, no.2, pp. 601-613.
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5
(b) Time (s) [4]G. Qingding, H. Qingtao and Q. Yanli, “Neural
Fig. 11 (a) frequency response of a 1.667Hz sinusoid input network real-time IP position controller on-line design
signal with 3 kg payload using FC (b) tracking error
for permanent magnetic linear synchronous motor,” in
15
Proceedings of the 7th International on Advanced
Command With Adaptation motion control, pp. 386-389, 2002.
Position (mm)
10
2
control in FPGAs,” IEEE Trans. on Indust. Electr.,
0 vol. 49, no. 2, pp. 415-422, 2002.
-2
[7]Z. Zhou, T. Li, T. Takahahi and E. Ho, “Design of a
-4
0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 Universal Space Vector PWM Controller Based on
(b) Time (s) FPGA,” in Proceedings of the 2004 Applied Power
Fig. 12 (a) frequency response of a 1.667Hz sinusoid input Electronics Conference and Exposition Conference,
signal with 3 kg payload using AFC (b) tracking error vol 3, pp. 1698 ~1702, 2004.