Professional Documents
Culture Documents
Fuzzy + PID Controller For Robot Manipulator
Fuzzy + PID Controller For Robot Manipulator
Fuzzy
Inference Fuzzy sets in V
Engine
-10 -5 0 5 10
0 1 0 0
0
−K −C 1 K 1
0
J1 J1 J1 -40 -30 0 30 40
C ou l o m b &
V i sco u s Fri c ti on 1
Co ul o m b &
V i sco u s Fri cti o n
5. Numerical simulations
Figure 6. Position output
Figure 6 shows that the position output (red)
follows the reference input (blue). Figure 7 shows the 0.4
manipulator. 0.1
Vel_EN C 1
Mot or Torq ue
P os _EN C 3
Ze ro-Ord er Vel_EN C 3
S co pe 1
Ho l d1
M o tor_l i n k d yn am i cs
Zero -O rde r
Hol d
Scop e2
Fuzzy L og i c
Co ntrol l e r
KD
1
1 S co pe3
KI Ga i n2
s
In teg rat or
du /dt
KP
Deri vat i ve S co pe5
P osi ti on
I np ut2
20
20
20
18
18
18
16
16
16
14
14 14
12
12 12
10
10
10
8
8
6
6 4
4 2
0
2 0 5 10 15 20 25
0
0 55 10
10 15
15 20
20 25
25
Figure 11. Position output with +25% in J
Figure 9. Position output
0.4
0.3 20
18
0.2
16
0.1 14
12
0
10
-0.1 8
6
-0.2
4
-0.3 2
0 5 10 15 20 25
0
0 5 10 15 20 25
2
If ðu/ðx 2 < 0 , then definitely the coefficients are all
0
positive (this can be relaxed if necessary) since all the
0 5 10 15 20 25
other system parameters are positive.
The control response for a disturbance from the
Figure 13. Position output with +25% in J2 equilibrium is shown in figure 15.
25
-3
x 10
20
4
15 2
0
10
-2
5 -4
-6
0.02
0
0 5 10 15 20 25 0.01 4
0 2
0 -3
Figure 14. Position output with +25% in J1 and J2 -0.01 -2 x 10
rate of encoder 1 output -0.02 -4
encoder 1 output