ỨNG DỤNG PID TRONG ĐIỀU KHIỂN CON LẮC NGƯỢC

1
CHƯƠNG 1
GIỚI THIỆU VỀ ĐỀ TÀI

1.1 Đặt vấn đề
Trong giảng dạy, có rất nhiều phương pháp để điều khiển tốc độ động cơ DC
nhưng thuật toán PID tỏ ra hiệu quả nhất, thường được dùng minh họa cho các ví dụ thiết
kế hệ thống trong môn học điều khiển tự động.
Luật điều khiển PID là mộ
t thuật toán điều khiển dễ và đơn giản ở các khía cạnh:
lý thuyết đơn giản, dễ chế tạo, dễ áp dụng, dễ sử dụng... mà vẫn đạt hiệu quả là đáp ứng
được việc điều khiển một quá trình nào đó ở giá trị mong muốn nên được dùng nhiều
trong công nghiệp như điều khiển nhiệt độ, áp suất, lưu lượng v.v...
Con lắ
c ngược được ứng dụng rất nhiều trong kỹ thuật và có thể sử dụng thuật toán
PID để điều khiển hệ thống này. Vì vậy nhóm chọn đề tài nghiên cứu là “ỨNG DỤNG
PID TRONG ĐIỀU KHIỂN CON LẮC NGƯỢC”.
Mô hình con lắc ngược có hai mô hình chính là Rotary và Liner, trong đề tài này
nhóm điều khiển mô hình Liner.
1.2 Tình hình nghiên cứu trong và ngoài nước
Bộ điều khiển PID hiện nay có hai loại: analog và digital.
Các bộ đi
ều khiển PID có trên thị trường của các hãng lớn thường được đóng gói
thành sản phẩm hoàn chỉnh, khi lắp đặt vào hệ thống không cần phải làm gì thêm ngoài
việc thiết lập các thông số hoạt động.
Công trình nghiên cứu về thiết kế bộ điều chỉnh PID số trong các tài liệu nghiên cứu ở
nước ngoài chủ yếu là thiết kế hoàn chỉnh một module điều khiển duy nhất từ thành phầ
n
xử lý tín hiệu, xử lý và tính toán trung tâm, công suất v.v... Bên cạnh đó, phần mềm

(chương trình điều khiển) trên máy tính chủ yếu vẫn là giao diện kiểu Terminal.


2
Trong nước cũng có nhiều đề tài nghiên cứu và ứng dụng bộ điều khiển PID,
nhưng phổ biến vẫn là dạng PID analog, bộ điều khiển PID số vẫn còn ít và chưa thật
hoàn chỉnh.









3
CHƯƠNG 2
CƠ SỞ LÝ THUYẾT
Lý thuyết điều khiển tự động.
2.1.Khái niệm:
a.Điều khiển.
Là quá trình thu tập thông tin, xử lí thông tin và tác động lên hệ thống để đáp ứng hệ
thống thõa yêu cầu đặt ra.
Điều khiển tự động là quá trình điều khiển không có sự can thiệp của con người.
b.Hệ thống điều khiển.
Gồm ba thành phần c
ơ bản: Bộ điều khiển, Đối tượng điều khiển, Thiết bị đo. Như
hình sau :

Bộ
điều khiển
Đối tượng
điều khiển
Thiết bị đo
Bộ so
e(t) u(t)
z(t)
y(ht)
y(t)r(t)
Thiết bị điều khiển


Hình 2.1: cấu trúc cơ bản của hệ thống diều khiển.


4
Trong đó :
• r(t): tín hiệu vào.
• e(t) : tín hiệu sai lệch.
• u(t) : tín hiệu điều khiển.
• z(t): tín hiệu nhiễu.
• y(t) : tín hiệu ra.
• y
ht
(t) : tín hiệu hồi tiếp

c. Bộ điều khiển.
Dùng tín hiệu sai lệch e để tạo tín hiệu điều khiển u. Thuật toán để xác định u(t)
gọi là thuật toán điều khiển.

Bộ điều khiển liên tục có thể thực hiện bằng cơ cấu cơ khí, thiết bị khí nén, mạch
điện RLC, mạch khuyếch đại thuật toán.
Bộ điều khi
ển số thực chất là các chương trình phần mềm chạy trên vi xử lí hay
máy tính.
d. Các nguyên tắc điều khiển.
¾ Nguyên tắc giữ ổn định.
Giữ tín hiệu ra bằng tín hiệu vào. Có ba nguyên tắc điều khiển giữ ổn định.


5

¾ Điều khiển bù nhiễu.


Đối tượng
điều khiển
u(t)
z(t)
y(t)r(t)
Bộ
điều khiển


Hình 2.2: sơ đồ diều khiển bù nhiễu.

Hệ thống lường trước nhiễu để tính toán, bù trừ sai số trước khi nhiễu ảnh hưởng
đến đối tượng. Vì không thể lường hết các nhiễu nên điều khiển bù nhiễu chất lượng
không cao.
¾ Điều khiển san bằng sai lệch.

Bộ
điều khiển
Đối tượng
điều khiển
Thiết bị đo
e(t) u(t)
z(t)
y(t)r(t)


Hình 2.3: Sơ đồ điều khiển cân bằng sai lệch.



6
Tín hiệu ra y(t) được đo và phản hồi về so sánh với tín hiệu vào r(t). Bộ điều khiển
sử dụng độ sai lệch vào-ra để tính toán tín hiệu điều khiển u(t). Nguyên tắc này có thể
triệt tiêu các nhiễu không biết trước và không đo được. Tuy nhiên, nó điều khiển sau khi
nhiễu đã thực sự ảnh hưởng đến đối tượng.
¾ Điều khiển phối hợp.


Bộ
điều khiển
Đối tượng
điều khiển
Thiết bị đo
e(t) u(t)
z(t)

y(t)r(t)


Hình 2.4: sơ đồ điều khiển phối hợp.

¾ Nguyên tắc điều khiển theo chương trình.
Tín hiệu ra thay đổi theo một hàm thời gian định trước.



7
¾ Nguyên tắc điều khiển thích nghi.

Đối tượng
điều khiển
u(t)
z(t)
y(t)r(t)
Bộ
điều khiển
Chỉnh định

Hình 2.5: sơ đồ điều khiển thích nghi
Khi cần điều khiển các đối tượng phức tạp, có thông số dễ bị thay đổi, hoặc nhiều
đối tượng đồng thời mà phải đảm bảo cho một tín hiệu có giá trị cực trị, hay một chỉ tiêu
tối ưu nào đó.
2.2.Bộ điều chỉnh PID liên tục.
a.Sơ đồ khối:

e

G(s)
y
Kp
Ki/s
K
D
.s
Bộ PID
r

Hình 2.6: sơ đồ khối bộ điều khiển PID liên tục



8
b. Phương trình vi phân:



Hình 2.7: đường đặc tính động học bộ PID

Trong đó:
• KP : hệ số khuyếch đại.
• KI : tốc độ tích phân.
• KD: hằng số thời gian vi phân.
• TI: thời gian hiệu chỉnh.
• TD:thời gian tác động sớm.

9

c.Kí hiệu PID:


Hình 2.8: kí hiệu bộ PID
d.Hàm truyền :

2
dpi
d
Ks Ks K
Ki
G(s) Kp K s
ss
++
=++ =

e.Đặc tính quá độ :



Hình 2.9: biểu đồ đặc tính quá độ của bộ PID
Khi không có thành phần I,D ta được bộ điều khiển P. Tương tự ta có bộ điều khiển
PI, PD.


10
f. So sánh các khâu hiệu chỉnh PI, PD, PID.

Hình 2.10: đáp ứng quá độ hệ thống


¾ Nhận xét :
• Khâu PI tốc độ đáp ứng nhanh, giảm thời gian quá độ
nhưng độ vọt lố tăng.
• Khâu PD giảm độ vọt lố, không ảnh hưởng sai số và
giảm dao động.
• Khâu PID với thông số thích hợp có thể hiệu chỉnh để
hệ thống ổn định với sai s
ố xác lập bằng 0, độ vọt lố và thời gian quá độ đạt yêu
cầu mong muốn.


11
¾ Ưu điểm của bộ PID:
• e(t) lớn : thông qua up(t), tín hiệu diều khiển u(t) càng
lớn.
• e(t) chưa bằng 0: thông qua uI(t), PID vẫn còn tạo tín
hiệu điều khiển.
• e(t) thay đổi lớn : thông qua uD(t), phản ứng của u(t)
càng nhanh.

2.3. Bộ điều chỉnh PID số (rời rạc).
a.Sơ đồ khối.

r(t)
e(t)

PID số ZOH G(s)
e(k)
T
u(k)
y(t)

Hình 2.11: sơ đồ khối bộ PID rời rạc

b.Phương trình vi phân PID liên tục.



Rời rạc hóa phương trình vi phân bộ điều chỉnh PID liên tục, thu được bộ điều
chỉnh PID số như sau:


12
U(t) thay bằng UK=U(k).
PI D
KKKK
UUUU=++


Khâu tỉ lệ:
Up(t) = Kp.e(t) thay bởi U
K
P
= Kp.e
K

Khâu vi phân:
DD
de(t)
U(t) K
dt
=
thay bởi
D
KK1
KD
ee
UK
T
−
−
=

Khâu tích phân:
I
KIK
UKe(t)dt=
∫
thay bởi
II
K1 K
KK1I
ee
UU KT
2
−

−
+
=+


¾ Phương trình PID số :


I
K1 K K K1
KPK K1I D
ee ee
UKe(U KT )K
2T
−−
−
+−
=++ +









13
CHƯƠNG 3
CÁC THIẾT BỊ

3.1.Động cơ DC
3.1.1.Định nghĩa:

Động cơ điện một chiều (DC) đã được sử dụng trong công nghiệp trong nhiều năm
qua. Cùng với các bộ điều khiển DC, động cơ điện một chiều cung cấp sự điều khiển rất
chính xác. Động cơ điện một chiều được sử đụng ở
những nơi yêu cầu moment mở máy
lớn hoặc yêu cầu điều chỉnh tốc độ bằng phẳng và phạm vi rộng như băng tải, thang máy,
máy ép, những ứng dụng trong ngành hàng hải, cán vật liệu, giấy, cao su…
Động cơ sevor DC là động cơ DC thông thường có hồi tiếp encorder hoặc
tachometer.




Hình 3.1: động cơ DC servo


14
Cấu tạo chung của động cơ DC gồm: vỏ, trục, ổ bi, phần cảm (stato), phần ứng
(roto), cổ góp và chổi điện


Hình 3.2: cấu tạo động cơ điện 1 chiều kích từ độc lập
Nguồn điện một chiều DC tác động lên cuộn ứng qua cổ góp. Cường độ từ trường
không thay đồi. Tốc độ động cơ chỉ có thể điều khiển thông qua dòng roto. Có thể đảo
chiều chuyển động bằng cách đảo chiều dòng điện qua roto


Hình 3.3: Động cơ DC từ tường vĩnh cửu

15

Uu
Ukt
+
Rf
I
-
Rkt
+
Ckt
-
A
-
+
MG2
1 2

Hình 3.4: Sơ đồ nối dây của động cơ KTĐL

3.1.2. Phương trình đặc tính cơ:
o U
ư
= E
ư
+ (R
ư

+ R
f
)*I
ư

Trong đó:
U
ư
: đệin áp phần ứng (V)
E
ư
: sức điện động phần ứng (V)
R
ư
: điện trở mạch phần ứng (Σ)
R
f
: điện trở phụ trong mạch phần ứng (Σ)
I
ư
: dòng điện trong mạch phần ứng (A)
o R
ư
= r
ư
+ r
cf
+ r
i
+ r

ct

Trong đó:
r
ư
: điện trở cuộn dây phần ứng
r
cf
: điện trở cuộn dây cực từ phụ
r
i
: điện trở cuộn bù
r
ct
: điện trở tiếp xúc của chổi điện
Sức điện động E
ư
của phần ứng động cơ được xác định theo biểu thức :


16
o
ωω
π
Φ=Φ= K
a
pN
E
u
2

Trong đó:
P : số đôi cực từ chính
N : số thanh dẫn tác dụng của cuộn dây phần ứng
a : số đôi mạch nhánh song song của cuộn dây phần ứng
Ф : từ thông kích từ dưới một cực (W
b
)
Τ : tốc độ góc rad/s

a
pN
K
π
2
=
: hệ số cấu tạo của động cơ
o
u
fu
u
I
K
RR
K
U
Φ
+
−
Φ

=
ω

Đây là phương trình đặc tính cơ điện của động cơ.


Mặt khác moment điện từ của động cơ được xác định bởi:
o M
ĐT
=
u
IKΦ

Nếu bỏ qua tổn thất cơ tổn thất thép thì moment cơ trên trục động cơ bằng moment
điện từ ký hiệu là M
o
()
M
K
RR
K
U
fu
u
2
Φ
+
−
Φ
=

ω

Đây là phương trình đặc tính cơ của động cơ điện DC kích từ độc lập
Giả thiết phản ứng phần ứng được bù đủ từ thông thông Ф = const, thì các phương
trình đặc tính cơ điện và phương trình đặc tính cơ là tuyến tính. Đồ thị của chúng được
biểu diễn trên hình 5, 6


17

NM
I
dm
ω
o
ω
I
ω
DM
I

Hình 3.5: Đặc tính cơ điện của động cơ DC kích từ độc lập


Hình 3.6: Đặc tính cơ của động cơ DC kích từ độc lập


¾ Ứng dụng.
-Robot.
-Điều khiển X,Y.

-Dùng trong cơ khí chính xác.




18
3.2.Encoder:
Thông thường encoder có:
+ 1 chân V
CC

+ 1 chân GND
+ có thể có 3 lối ra: A, B ( căn cứ vào đây để biết hướng, vận tốc) và Z ( điểm 0
hay dây trung tính)


Hình 3.7: động cơ DC có gắng encoder
1. Cung cấp nguồn hệ thống
2. Bộ điều khiển số
3. Module điều khiển
3.2.1 Các loại encoder:
a. Encoder số:
Mỗi một Encoder số bao gồm một đĩa tròn với các vạch kẻ mẫu ở trên. Các vạch
mẫu này được đọc bơpỉ các đầu cảm biến. Đĩa này thường đi kèm với tr
ục quay của nó,
trục này làm quay những mẫu phát tín hiệu cho mỗi vị trí nhận được. Cách ghi các mã
trên đĩa phụ thuộc vào các mẫu trên nó
Phân loại theo cấu tạo vật lý thì hiện nay Encoder thường có ba loại: Encoder tiếp
xúc, Encoder từ trường và Encoder quang

19
b.Encoder tiếp xúc:
Điểm tiếp xúc thực tế của loại Encoder này là giữa đĩa và đọc thông qua chổi than.
Loại này có nhược điểm là tạo ma sát, hao mòn, bụi bẩn do mụi than, xuất hiện điện trợ
tiếp xúc, gây ra rung động … làm giảm độ chính xác và tuổi thọ
Độ phân giãi của Encoder phụ thuộc vào đường rãnh và độ chính xác nhỏ nhất của
một rãnh có thể có được trên đĩa, độ phân giải có thể đạt 10 rãnh trên đĩ
a. Độ phân giãi có
thể tăng lên bằng cách ghép nhiều tầng đĩa hoặc dùng bộ dếm 9lên xuống cho trạng thái
cao nhất của bit
c.Encoder từ trường:
Đối với Encoder từ trường thì đĩa quay của nó được tráng một lớp vật liệu từ, trong
đó những vạch mẫu không được phủ.Các vạch này được đọc bằng một đầu đọc nam
châm.Rõ ràng với ưu điểm này thì Encoder từ trường có tuổi th
ọ cao hơn Encoder tiếp
xúc
d.Encoder quang:
Encoder quang là loại thông dụng nhất nhờ có độ chính xác cao và dùng ánh sáng
của bán dẫn. Encoder có ba bộ phận: đĩa segment có những phần trong suốt cho ánh sáng
đi qua và những phần không cho ánh sáng đi qua, một nguồn sáng cùng với một hệ thống
hỗ trợ chiếu sáng,bộ phận cảm biến ánh sáng
Hầu hết Encoder được sản xuát với độ chính xác cao, một Segment có bề dáy xấp
xỉ 12 micros. Độ phân giải của Encoder quang thông thường có th
ể đạt đến 14 bits.


Hình 3.8:Một số Encoder quang

20
e.Bộ giải mã tuyệt đối:
Là loại thiết bị mã hóa mà các tín hiệu mã đầu ra song song để chỉ thị góc quay
tuyệt đối của trục. Loại này không cần bộ đếm để đếm xung mà vẫn có thể biết góc quay
của trục thiết bị mã hóa


Hình 3.9: Đĩa Encoder quang

Cũng giống như nhiều loại Encoder khác, bộ giải mã tuyệt đối gồm một đĩa tròn,
trên đó có những khoảng trong suất và đục. Ánh sáng có thể xuyên qua những phần trong
suất đến bộ cảm biến quang, khi đĩa quay thì bộ cảm biến bật lên 1 và phần ánh sáng bị
chặn bởi phần đục làm cảm biến quang xưống 0. Như vậy cảm biến quang sẽ tạ
o thành
những xung tuần tự
Khi thiết bị mã hóa này được sử dụng với cùng một thiết bị khác, thì vị trí 0 của
trục xam như góc tọc độ. Khi trục của thiết bị mã hóa quay về tọa độ góc này thì góc quay
có thể được hiển thị trên bộ chỉ thị của máy. Tín hiệu đầu ra của thiết bị mã hóa không bị
ảnh hưởng bởi nhiễu của thiết bị đóng, ngắt và không yêu c
ầu điều chỉnh góc quay chính
xác. Hơn nữa, thậm chí nếu tín hiệu mã hóa đầu ra khộng thể đọc vì trục quay quá nhanh,
thì góc quay chính xác được ghi khi tốc độ quay giảm xuống, hoặc ngay khi nguồn cho
thiết bị mả hóa bị ngắt. Thêm nữa, mã hóa sẽ không hoạt động do sự rung động của các
thiết bị sử dụng nó
Loại thiết bị mã hóa tuyệt đối, có độ phân giải cao hơn và cho ra các giá trị thay
đổi trong phạm vi r
ộng hơn so với thiết bị mã hóa tăng dần.

21
f. Thiết bị mã hóa tăng dần:



Hình 3.10: Thiết bị mã hóa tăng dần trong Encoder

Là loại thiết bị mã hóa có dãy xung ra phù hợp với góc của trục quay. Thiết bị mã
hóa này không có xung ra khi trục không làm việc. Do đó cần có một bộ đếm để đếm
xung ra
Thiết bị mã hóa ch biết vị trí của trục quay bằng số xung được đếm. Dạng thiết bị
mã hóa này chỉ có 1 hay 2 kênh nhõ ra:
Loại 1 chiều (chỉ có đầu kênh A) là loại chỉ sinh ra xung khi trục quay
Loạ
i 2 chiều (có đầu ra kênh A và B) cũng có thể cho biết chiều của trục quay,
nghĩa là thuận chiều kim đồng hồ. Ngoài ra còn có đầu dây trung tính (xung Z) cho mỗi
vòng quay, có nghĩa là nếu quay được 1 vòng thì xung Z lên 1
Khi đĩa quay theo chiều kim đồng hồ thì xung track 1 (B) trễ pha hơn xung track 2
(A)


22
g. Quay thuận chiều kim đồng hồ:


Hình 3.11: Các kênh tín hiệu ra của Encoder


Hình 3.12: Các kênh tín hiệu ra của Encoder khi động cơ quay thuận

Đầu A vượt quá B (độ lệch pha) = 90
O
+ 45
O
(T/4 + T/8)

h.Quay ngược chiều kim đồng hồ:


Hình 3.13: Các kênh tín hiệu ra của Encoder khi động cơ quay nghịch




23
3.3.Mạch kích Atmega8

T1
ADC3
MISO
R17
390
+5V
J4 DIPSOC-14x2
1
2
3
4
5
6

7
8
9
10
11
12
13
14
28
27
26
25
24
23
22
21
20
19
18
17
16
15
PC6(RESET)
PD0 (RXD)
PD1 (TXD)
PD2 (IN T0)
PD3 (IN T1)
PD4 (XCK/T0)
VCC
GND

PB6 (XTAL1/TOSC1)
PB7 (XTAL2/TOSC2)
PD5 ( T1)
PD6 ( AIN 0)
PD7 ( AIN 1)
PB0 (I CP1)
PC5 (ADC5/SCL)
PC4 (ADC4/SDA)
PC3 (ADC3)
PC2 (ADC2)
PC1 (ADC1)
PC0 (ADC0)
GND
AREF
AVCC
PB5 (SCK)
PB4 (MISO)
PB3 (MOSI/OC2)
PB2 (SS/OC1B
PB1 OC1A
R1
47K
RXD
SCK
RXD_RF
JP4
1
2
3
Le Tan Cuong <R

MODULE ATMEGA8
C
11Thursday , Oc tober 08, 2009
Tit le
Size Doc ument Num ber Rev
Date: Sheet
of
+5V
PD7
C18
470uF/ 25V
R5
390
R19
47K
ADC2
C10
0.1u
INT1
R4
4.7K
C12
0.1uF
MISO
PB7
C3
104
C5
18p
SW3

BUT1
TXD_USB
+5V
J10
COUNTER INTERFACE
1
2
3
4
R11
1K
R16 0
MOS I
PB7
R2 100
+5V_U SB
INT0
LED1
J9
INTERRUPTS INTERFACE
1
2
3
4
LED2
JP5
1
2
3
RXD_USB

J11
EXT VREF
1
2
3
R18
47K
+5V
C4
104
J12
COMPARE INTERFACE
1
2
3
4
R14
1K
ADC2
ADC1
-+
D1
BD104(SMD)
1
4
3
2
+5V
J13
RS232_RXD SEL

4
56
12
3
C7
0.1uF
MOS I
INT0
+5V
J16
RS232_TXD SEL
4
56
12
3
TXD_23 2
T1
PD6
PD6
PB0
MAX232
U1
1
3
4
5
16
15
2
6

12
9
11
10
13
8
14
7
C1+
C1-
C2+
C2-
VCC
GND
V+
V-
R1OUT
R2OUT
T1I N
T2I N
R1IN
R2IN
T1OU T
T2OU T
C11
0.1uF
+5V
+5V
JP6
1 2

TXD
J8
I/O INTERFACE
1
2
3
4
COM1
1
6
2
7
3
8
4
9
5
C19
104
+5V
OC1A
SCK
SW2
BUT2
+5V
+5V
MISO
TXD_RF
PC4
C17

104
+5V
ADC1
PB2
ADC0
TXD_232
R15
1K
SW1
RESET
SW4
BUT4
R20
38K
PB2
OC1A
RESET
PC4
T1
INT1
RXD_232
AIN_E
RXD
J3
ICIS P
1 2
3 4
5 6
7 8
9 10

PB6
JP7
1 2
+5V
PC5
RXD_232
PWR LED1
+5V
T0
JP3
12
TXD
+5V_USB
+5V
TXD_USB
RESET
J5
ADC INPUT
2
4
6
8
10
12
1
3
5
7
9
11

L1
47uH
1
2
RF_EN
J1
ISP INTERFACE
6
5
4
3
2
1
PC5
PD6
ADC0
R13
22K
J6
PWM INTERFAC E
1
2
3
4
C2
104
+5V
OC1A
PB2
JP1

12
+5V
RXD_RF
PD7
JP2
12
J2
MODULE ISP LED SEGMEN
6
5
4
3
2
1
RS232
MOS I
T0
R9
10K
PC5
RF_EN
C13
0.1uF
+5V
T0
R21
15K
TXD_RF
SW5
BUT3

R3
4.7K
R10
1K
R12
22K
PC4
PB6
C9
0.1u
SCK
INT0
X1
7.372M
RESET
J17
PWR_JACK
3
2
1
+5V
SCK
C15
0.1u
J15
MODULE USB-RS232
1
2
3
4

5
6
+5V
RXD_USB
C8
0.1uF
+
C16
47uF/6V3
ATISP
PB0
R6
390
R8
22K
+5V_REG
ADC3
PB2
MISO
INT1
+5V_REG
+5V
J7
I2C INTERFACE
1
2
3
4
C6
18p

PD7
+5V
MOSI
ADC0
R7
22K
C14
0.1u
U2 L78M05/TO220
1
2
3
VIN
GND
VOUT
+5V
J14
MODULE RF
1
2
3
4
5
6
C1
104
Hình 3.14: Mạch nguyên lý ATMEGA8

24
3.4.Mạch cầu H

U2A
4001
1
2
3
U4
IR2184
3 4
8
1
5
2 6
7
COM LO
VB
IN
VCC
SD VS
HO
U9
PC817
12
43

Q4
IRF540
DIR
D4
POWER LED
<Doc> <Rev
<Title>
B
11Monday , May 17, 2010
Tit le
Size Document Number Rev
Date: Sheet
of
R6
4.7R
5V
R2
4.7k
J4
CON1
1
PWM
5V
R9
3K3
+
C1
4.7u
U1A
4001

1
2
3
C8
10uF 16V
R4 4.7R
D5
DIR LED
R5
4.7R
PWM
Q2
IRF3205
D2
DIODE
R3
4.7k
24V
U5A
4001
1
2
3
Q5
BD139
C5
0.1uF
DIR
U6A
4001

1
2
3
147
R14 330
+
C4
470u
Q1
IRF540
5V
5V
+
C2
4.7u
Q3
IRF540
12V
J1
MOTO R
1
2
24V
R7
4.7R
D3
12V
J2
MOTO R
1

2
J3
POWER
2
1
C6
104
R10
680
R11
560
24V
R12 1k
R8
220R
D1
DIODE
U7
PV900V
1
2
3
4
65
R1
4.7k
12V
C7
10uF 16V
+

C3
4.7u
R13
3k3
U3
IR 2184
3 4
8
1
5
2 6
7
COM LO
VB
IN
VCC
SD VS
HO
U8 78L05
3
2
1
OUT
GND
IN
Hình 3.15: Mạch nguyên lý mạch cầu H

25
3.5.Kết cấu cơ khí

Hình 3.16: Phần cứng của cơ khí của con lắc ngược
3.6. Mạch Điều Khiến

Hình 3.17: Mạch điều khiển