Professional Documents
Culture Documents
Bài 1: (3đ)
a. Drawing a general diagram of a servo system for a 3-axis CNC machine using
DC servo motors.
It is similar to the figure 2.1 in the lecture note (chapter 2)
b. What are differences between semi-closed loop and full-closed loop system?
According to your diagram from (a), is it a open-loop, semi-closed loop or full-
closed loop system?
In many servo systems, a feedback system can be only established based on the
information of servo actuator. This kind of control system is called a semi-
closed loop. Otherwise, a full closed-loop is a system that feedback information
is obtained from a mechanism part
Full-closed loop
OUT 1
IN 1
H-Bridge 1
IN 2
OUT 2
CONTROLLER
OUT 3
IN 3
H-Bridge 2
IN 4
OUT 4
1 phase ON
OUT1 + 0 - 0 + 0 - 0 + 0 - 0
OUT2 - 0 + 0 - 0 + 0 - 0 + 0
OUT3 0 + 0 - 0 + 0 - 0 + 0 -
OUT4 0 - 0 + 0 - 0 + 0 - 0 +
Dựa vào bảng trên sinh viên vẽ lại lưu đồ giải thuật
2 phase ON
OUT1 + + - - + + - + + 0 - -
OUT2 - - + + - - + - - 0 + +
OUT3 - + + - - + + - + + + -
OUT4 + - - + + - - + - - - +
Dựa vào bảng trên sinh viên vẽ lại lưu đồ giải thuật
Điều khiển “2 phase ON” giúp tăng moment lực của động cơ lên khoảng 30%-
40% so với “1 phase ON”
Số hiệu: BM1/QT-PĐBCL-RĐTV 1
b. Cho sơ đồ khối bộ điều khiển tốc độ động cơ DC servo như hình:
Để giảm ảnh hưởng của việc tốc độ đặt thay đổi đột ngột và sự nhạy với nhiễu
tần số cao của khâu D, ta sử dụng bộ điều khiển PID sữa đổi như sau:
K s K
U (s) K p E (s) D (s) I E (s)
Ns 1 s
Viết giải thuật PID cho bộ điều khiển số bất kỳ sử dụng phương trình trên?
Tính sai số
ek d k k (2.1)
Khâu P:
u P k K p ek (2.2)
Khâu I (sử dụng công thức tích phân lùi)
u I k u I k 1 K I Tek (2.3)
T: thời gian lấy mẫu (s)
Khâu D:
k 1
u D (k ) K D k (2.4)
T
u f (k ) (1 )u D f (k 1) u D (k )
D
(2.5)
T
Với ( 0 1)
TN
Sử dụng các phương trình (2.1) đến (2.5) sinh viên viết lại lưu đồ giải thuật
Bài 3: (3đ) Sử dụng giải thuật DS để nội suy 1 cung tròn ở góc phần tư I, theo chiều
kim đồng hồ (CW), R=6.
a. Lập bảng tính các giá trị cần thiết theo lưu đồ giải thuật?
b. Vẽ kết quả chạy được theo bảng câu a?
c. Tính sai số của hình nội suy được?
a.
D D1 D2 D3 X Y X Y
0 0 1 -11 0 0
1 1 1 -11 -10 3 -11 1 0
2 4 4 -10 -7 5 -11 1 0
3 -2 9 -7 -2 7 -9 1 1
4 -4 5 -11 -4 9 -7 1 1
5 -2 5 -11 -2 11 -5 1 1
6 4 9 -7 4 13 -3 1 1
Số hiệu: BM1/QT-PĐBCL-RĐTV 1
7 1 17 1 14 13 -1 0 1
8 0 14 0 13 13 1 0 1
0
0 1 2 3 4 5 6
c.
1 1
Diện tích của ¼ cung tròn: S R 2 3.14 62 28.26
4 4
1
Diện tích của hình nội suy được: S1 2 6 (2 6)4 28
2
S S
Sai số nội suy 1 100% 0.9%
S
Số hiệu: BM1/QT-PĐBCL-RĐTV 1