PIC Vietnam

Go Back   PIC Vietnam > Robotics > Thực hành

Tài trợ cho PIC Vietnam
Trang chủ Đăng Kí Hỏi/Ðáp Thành Viên Lịch Tìm Kiếm Bài Trong Ngày Ðánh Dấu Ðã Ðọc Vi điều khiển

Thực hành Bắt đầu làm một robot như thế nào? Mẹo vặt? Kỹ thuật? Công nghệ?... Hãy bắt tay vào việc...

Trả lời
 
Ðiều Chỉnh Xếp Bài
Old 31-03-2009, 02:38 AM   #1
mgdaubo
Đệ tử 1 túi
 
Tham gia ngày: Oct 2006
Bài gửi: 19
:
Cho em hỏi: biểu thức toán học của PID là
Code:
U(t) = Kp*e(t) + Ki*tich_phan(e(t)) + Kd*vi_phan(e(t)) ;     (1)
Vậy sao lại biến đổi ra biểu thức PID rời rạc điều khiển động cơ là:
Code:
duty = duty + Kp*e2 + Ki*e_sum + Kd*e_del;     (2)
Theo em nghĩ thì phải là "duty = Kp*e2 + Ki*e_sum + Kd*e_del;" mới đúng chứ??? (không phải là cộng dồn duty lên...)

Em có làm thử theo công thức thứ (2) mà mới để Kp = 1; Ki = Kd = 0; mà động cơ đã vọt lố, giao động mạnh rồi, phải dùng tay ghì bánh xe lại (tải rất lớn) thì động cơ mới đỡ giao động ???
mgdaubo vẫn chưa có mặt trong diễn đàn   Trả Lời Với Trích Dẫn
Old 31-03-2009, 07:16 AM   #2
Mecha
Trưởng lão PIC bang
 
Mecha's Avatar
 
Tham gia ngày: Dec 2005
Bài gửi: 315
:


Trên đây là công thức tính PID (cấu trúc song song) rời rạc đã được đề cập đến trong rất nhiều sách.

Kp, Ti, Td: thông số của PID
Ts: chu kỳ trích mẫu


<code>

// sense: đọc dữ liệu từ sensor
ek = ref – pv; // pv = present value

// calculate & anti-windup limits
uk = theo công thức;

if ( uk > ukmax )
uk = ukmax;
else if ( uk < ukmin )
uk = ukmin;

// update biến trạng thái
ek-2 = ek-1;
ek-1 = ek;
uk-2 = uk-1;
uk-1 = uk;

// actuate: ghi dữ liệu ra actuator
outPortUk.data()->Set(uk); // ví dụ 1 lệnh gửi dữ liệu ra output port

</code>

Chú ý tuần tự thực hiện nên là: sense(), calculate(), update(), actuate().

Astrom and Wittenmark có đề xuất là “writing first”, khi đó tuần tự thực hiện sẽ là actuate(), sense(), calculate(), update(). Tuy nhiên trong vấn đề này mỗi người có một quan điểm khác nhau.
__________________
Sống là động nhưng lòng luôn bất động,
Sống là thương nhưng lòng chẳng vấn vương,
Sống yên vui danh lợi vẫn coi thường,
Tâm bất biến giữa dòng đời vạn biến.


Chú ý: đề nghị các thành viên đọc luồng dưới đây trước khi post bài:
http://www.picvietnam.com/forum//showthread.php?t=1263

thay đổi nội dung bởi: Mecha, 31-03-2009 lúc 07:21 AM.
Mecha vẫn chưa có mặt trong diễn đàn   Trả Lời Với Trích Dẫn
Trả lời

Ðiều Chỉnh
Xếp Bài

Quyền Sử Dụng Ở Diễn Ðàn
You may not post new threads
You may not post replies
You may not post attachments
You may not edit your posts

BB code is Mở
Smilies đang Mở
[IMG] đang Mở
HTML đang Tắt

Chuyển đến


Múi giờ GMT. Hiện tại là 11:44 AM.


Được sáng lập bởi Đoàn Hiệp
Powered by vBulletin®
Page copy protected against web site content infringement by Copyscape
Copyright © PIC Vietnam