Tài liệu hạn chế xem trước, để xem đầy đủ mời bạn chọn Tải xuống
1
/ 24 trang
THÔNG TIN TÀI LIỆU
Thông tin cơ bản
Định dạng
Số trang
24
Dung lượng
457,09 KB
Nội dung
• CAO HOÀI PHƯƠNG • TRẦN NHƠN • TRƯƠNG VĂN CẢNH • LÊ VIỆT VŨ • NGUYỄN THANH THIỆN • BÙI VĂN MINH ĐIỀUKHIỂNVẬNTỐCĐỘNGCƠDCBẰNG THUẬT TOÁN PID I. GIỚI THIỆU II. Incremental Optical Encoder III. Chip driver L298D: DUAL FULL-BRIDGE DRIVER IV.Mạch logic cho L298D. V. Giải thuật điềukhiển PIC. VI.Điều khiểnDC Motor bằng PIC. VII.Mạch logic cho L298D. • !"#$%&%'()*+, -./!"**0",, 12%3 *45- • 67.#!"8(9:;0 • 8<01040!"= >?,!=6@6&4#'1- >,!=A'8,B4 • B4C(D.6@%&.,##7!E0FF • 4$%&=B%G!H1A%3E#EI7%7E JE))BC."#'K6* • L@%&C4%MNOPQRRENQPRR • 8<'!1S!".JS65.MT,U ." .B5 • C04CVW.B5=()XY#!"(D4 ,UZ+,RCV[\,U%Z40]!^E_,6`,U Z12.B5F • aCVK-:;0!"#T,U#"KT,##'K6* I!"%.7 • bW.B5KT,7U0,(FcB5##5.".B5 -+,12J^7RF CONTROL:C.B")BC .".B0ER* LOGIC:-.(;Z4d ',4d03200%.7 POWER: 0%.7<eQ." II. Incremental Opcal Encoder: • 65.MT,U,U.B5/_,*;0)I 128T,U+,# • a4J8T,U+,#(,9#,#77B,,#77.B 5T,U E%3(;fR,UE]%37%7 • C1040,,!."%30:,,!7%77%7T, 8# 01040%,! • b50:,!7%7(,9##904T,1A!"9' gP,7% E#)#(;T,."#h,8,i • j%71A8k^kl, (,9#^?E^m."^%7R • n^+,7%7!"#!op(^0S,+,h,T,U."#]00,q %"^!op"UF • n^?+,7%7!"(^"h,T,U12,"4ip."# ]0q044%"4i"UF • n^m+,7%747%7M8#]004412]^ 31AM.^?1!#_!>rEsi [...]... chỉ được dùng đề đảo chiều độngcơ mà còn điềukhiển vận tốcđộngcơ bằng PWM • Trên chip L298D còn có các đường Vss cấp điện áp cho phần logic (5V) và GND chung cho cả logic và motor IV Mạch logic cho L298D • • • khi thiết kế một mạch driver cho motor người ta thường dành 3 đường điềukhiển đó là PWM dùng điều khiểnvận tốc, DIR điềukhiển hướng và En cho phép mạch hoạt động Chip L298D đã có sẵn đường... đó, ta chỉ có thể tính toán gần đúng bằng cách ta cho Δ t= ε rất nhỏ nhưng lớn hơn 0 hệ thức PID rời rạc: • Thành phần tích phân: • Thành phần vi phân: VI ĐiềukhiểnDC Motor bằng PIC • • • • • • • Phần này chúng ta sẽ vận dụng tất cả phần lý thuyết giới thiệu ở trên để viết chương trình cho PIC16F887 Mục đích là điều khiểnvậntốc của DC Motor bằng giải thuật PID Mạch điện mô phỏng được trình bày... phân) và Derivative (đạo hàm).Tuy xuất hiện rất lâu nhưng đến nay PIDvẫn là giải thuật điềukhiển được dùng nhiều nhất trong các ứng dụng điềukhiển tự động • Trong miền thời gian, bộ điềukhiểnPID được mô tả bằng mô hình vào ra: • • trong đó e(t) là tín hiệu ngõ vào, u(t) là tín hiệu ngõ ra của bộ điềukhiển Tuy nhiên, đối với Vi Điềukhiển nói chung, việc tính toán các thành phần P,I,Dnói cách khác... cóvậntốc không tải tối đa là 1000rpm (revolute per minute) Encoder dùng cho motor được chọn có độ phân giải 300 pulse/vòng Kênh A của encoder được nối với chân counter Timer1 T1CKI để đếm xung, Keypab được nối với PORTA để cài đặt vậntốc mong muốn cần điềukhiển Một Text LCD được nối với PORTD với chế độ truyền dữ liệu 4 BIT dùng hiển thị vậntốc thực của motor đọc từ Encoder (Actual speed) và vận. .. dùng hiển thị vậntốc thực của motor đọc từ Encoder (Actual speed) và vậntốc cài đặt (Desired speed) Giải thuật PID số được vận hành bởi PIC trong thời gian lấy mẫu là 10ms Timer 0 được dùng để tạo khoảng thời gian 10ms Timer 1 (16 bit) là bộ đếm counter nối với encoder.Timer 2 (8 bit) là bộ tạo PWM điềukhiển vận tốcđộngcơ ... có sẵn đường En nhưng 2 đường điềukhiển In1 và In2 không thật sự chức năng như chúng ta mong muốn chúng ta sẽ thiết kế một mạch logic phụ với 2 ngõ vào là PWM và DIR trong khi 2 ngõ ra là 2 đường điềukhiển In1 và In2 Bảng 1.bảng chân trị của mạch logic cho driver L298D Viết hàm bool cho 2 ngõ In1 và In2: In1=PWM.NOT(DIR) In2=PWM.DIR V Giải thuật điềukhiểnPIDPID là cách viết tắt của các từ Propotional...• Giải pháp để đọc encoder bằng PIC +Dùng input capture +Dùng chức năng counter + Sử dụng ngắt ngoài III Chip driver L298D: DUAL FULL-BRIDGE DRIVER • • L298D là một chip tích hợp 2 mạch cầu H trong gói 15 chân L298D có điện áp danh nghĩa cao (lớn nhất 50V) và dòng điện danh nghĩa lớn hơn 2A nên rất thích hợp cho các các ứng dụng công suất nhỏ như các động cơDC loại nhỏ và vừa Mô hình thật của... chip Cấu trúc bên trong chip • Có 2 mạch cầu H trên mỗi chip L298D nên có thể điềukhiển 2 đối tượng chỉ với 1 chip này • Mỗi mạch cầu bao gồm 1 đường nguồn Vs , một đường current sensing , phần cuối của mạch cầu H không được nối với GND mà bỏ trống cho người dùng nối một điện trở nhỏ gọi là sensing resistor • Độngcơ sẽ được nối với 2 đường OUT1, OUT2 (hoặc OUT3, OUT4 nếu dùng mạch cầu bên phải) • . MINH ĐIỀU KHIỂN VẬN TỐC ĐỘNG CƠ DC BẰNG THUẬT TOÁN PID I. GIỚI THIỆU II. Incremental Optical Encoder III. Chip driver L298D: DUAL FULL-BRIDGE DRIVER IV.Mạch logic cho L298D. V. Giải thuật điều khiển. L298D: DUAL FULL-BRIDGE DRIVER IV.Mạch logic cho L298D. V. Giải thuật điều khiển PIC. VI.Điều khiển DC Motor bằng PIC. VII.Mạch logic cho L298D. • !"#$%&%'()*+, -./!"**0",,