Tài liệu chương 1: khái quát động cơ servo docx

PAN-TILT
Lời mở đầu
Sau 1 khoảng thời gian học tập, tìm hiểu và làm việc nghiêm túc,
đồ án đã hoàn thành đúng kỳ hạn. Để có được thành quả này, một
mặt là sự cố gắng và kiến thức của bản thân, mặt khác còn là sự chỉ
dẫn tận tình của thầy cô, sự giúp đỡ của bạn bè. Xin được gửi lời
cảm ơn đến Thầy KS. Lê Tấn Cường, giáo viên hướng dẫn, người
đ
ã trực tiếp chỉ bảo, giúp đỡ nhóm thực hiện trong suốt thời gian
thực hiện đồ án.
A. Tổng quan đề tài:
Sau 1 khoảng thời gian hơn 2 tháng học tập và làm việc, đề
tài đ
ã hoàn thành đúng thời hạn. Đề tài đã giải quyết được những
vấn đề trọng tâm sau:
- Nghiên cứu sử dụng phần mềm MatLab, một trong những phần
mềm kỹ thuật mạnh nhất hiện nay.
- Nghiên cứu sử dụng công cụ lập trình giao diện GUI trên
MatLab.
- Nghiên c
ứu chuẩn RS232 và giao tiếp máy tính bằng MatLab.
- Tìm hiểu họ vi điều khiển AVR - Atmega 32.
- Tìm hi
ểu cấu trúc hệ Pan-Tilt, thiết kế được 1 hệ Pan-Tilt cơ bản.
- Tìm hiểu cảm biến siêu âm SRF04, xác định khoảng cách dùng
SRF04.
MatLab Programing
Hình 01: Sơ đồ khối tổng thể
* Quy trình:
- Vi điều khiển (VĐK) gởi tín hiệu điều khiển hệ Pan-Tilt
ho

ạt động (mang cảm biến quay và quét).
- Trong quá trình Pan-Tilt quay, c
ảm biến SRF04 liên tục
phát ra sóng để đo khoảng cách xác định có vật
. Khi có vất, SRF04
gởi tín hiệu (giá trị tọa độ tại điểm có vật) về VĐK.
- VĐK gởi tọa độ này lên máy tính để thực hiện việc vẽ biên
d
ạng vật.
B. Lý thuyết:
I. Cảm biến siêu âm SRF04 (Sonar Range Finder):
1. Giới thiệu SRF04:
- Siêu âm Devantech SRF04 được sử dụng để thu các thông
tin về khoảng cách một cách chính xác trong dải từ 3cm đến 3m.
Sensor này gồm bộ thu phát siêu âm tách biệt, sensor có 4 chân nối
trong đó hai chân cho nguồn nuôi, hai chân c
òn lại một cho xung
tín hiệu vào (Trigger Pulse Input), một cho tín hiệu ra (Echo Pulse
Output).
Hình 2.1: Mặt top SRF04
Hình 2.2: Mặt bottom SRF04
- SRF04 hoạt động thông qua việc truyền một xung âm thanh
có tần số nằm ngoài dải tần số nghe của con người. Xung này
truy
ền ở tốc độ âm thanh khoảng 0.9ft/giây, dưới dạng một chùm
hình nón, âm thanh ph
ản xạ trở lại tới đầu thu từ vật thể bất kì trên
đường đi của sóng siêu âm. Tín hiệu điện tại đầu thu có dạng các
xung với độ kéo dài xung phụ thuộc vào khoảng cách phản xạ kể
từ vị trí vật tới đầu thu. Để việc thu phát làm việc hiệu quả, bộ phát

tạm ngừng phát sóng trong khoảng thời gian siêu âm được truyền
sau đó đợi tín hiệu phản xạ.
- Xung ở đầu ra của sensor được đưa tới chân ngắt INT2 của vi
điều khiển.
Việc xác định thời gian kéo dài xung sẽ giúp cho chúng
ta xác định được khoảng cách.
2. Thông số kỹ thuật:
+ Điện áp sử dụng: 5VDC.
+ Dòng tiêu thụ: cực đại là: 50mA, thường là 30mA.
+ Vùng làm vi
ệc của sensor: phát hiện khoảng cách từ 3cm
tới 3m.
+ T
ần số sử dụng 40Khz.
+ Xung kích phát 10us mức cao tương thích TTL.
+ Xung phản xạ mức cao có độ rộng xung tỉ lệ với khoảng
cách.
+ Góc m
ở của bộ phát : 30
0
.
+ Vùng làm việc của sensor: phát hiện khoảng cách từ 3cm
tới 3m.
3. Nguyên lý hoạt động:
Hình 3: Giản đồ xung thu phát SRF04
- Tín hiệu xung kích phát siêu âm được giữ ở mức thấp (logic
0) và sau đó đưa lên mức cao (logic 1) trong 10us để khởi phát
xung siêu âm. Trong đề t
ài, chúng em tạo xung trigger từ chân
PD.7 của VĐK, nối chân này với chân Trigger Pulse Input của

SRF04 để kích nó hoạt động.
- Xung siêu âm được tạo ra thông qua sườn xuống của tín
hiệu lối vào. Sau khi được kích phát, sóng siêu âm sẽ được phát ra
trong 8 chu kì burst. Bộ nhận sẽ giữ khoảng trống trong khoảng
thời gian chừng 100us để tránh nhiễu... và sau đó cho tự động tạo
xung cạnh lên ở chân Echo (set chân này lên mức cao). Lúc này sẽ
có ngắt cạnh lên ở INT2 của VĐK.
- Sóng siêu âm từ cảm biến phát ra ngoài môi trường, phản
xạ trở lại khi gặp vật cản. Khi có tín hiệu phản xạ về cảm biến thì
c
ảm biến sẽ đưa chân Echo xuống mức thấp, lúc này tạo ra ngắt
canh xuống ở chân INT2. Trường hợp nếu không gặp vật cản nào
thì chân Echo s
ẽ tự động rớt xuống mức thấp sau 1 khoảng thời
gian timeout mặc định là 36ms kể từ lúc có cạnh lên trên chân
Echo.
-
Để xác định được khoảng cách giữa cảm biến và vật, ta tiến
hành đo khoảng time từ lúc có xung cạnh l
ên tới lúc có xung cạnh
xuống trên chân Echo. Cụ thể chúng em dùng ngắt INT2 để xác
định thời điểm có xung cạnh l
ên/xuống (trên chân Echo) và kết
hợp với Timer0 (có ngắt tràn) để đo khoảng time đó.
- Kết quả đo tính theo lý thuyết của nhà sản xuất:
Khoảng cách (cm) = Thời gian(us)/58
Khoảng cách (inch) = Thời gian(us)/148
3. Sử dụng cảm biến:
3.1. Kết nối phần cứng:
Hình 4: Kết nối phần cứng SRF04 với VĐK

- Chân số 1 (5V Supply): mắc lên 5V cấp nguồn cho SRF04.
- Chân số 2 (Echo Pulse Output): tín hiệu ngõ ra.
- Chân s
ố 3 (Trigger Pulse Input): chân cấp xung kích SRF04
hoạt động.
- Chân số 4 (Do Not Connect): để trống, không kết nối.
- Chân số 5 (0V Ground): nối xuống mass.
* Từ sơ đồ chân của SRF04, ta kết nối SRF04 và VĐK như hình 4
3.2. Vấn đề gặp phải khi sử dụng cảm biến để quét:
AT
Mega32
SRF04
5V
echo
trigger
NC
GND
INT2
PD.7
1
1
2
3
4
5
3