Từng bước chế tạo Robot - pdf 20

Download miễn phí Từng bước chế tạo Robot



Robot của bạn được điều khiển chuyển động bằng 2 động cơ DC, như mô phỏng ở trên.
Yêu cầu: Lập trình cho Robot thực hiện các chuyển động sau:
- Chạy tới
- Chạy lui
- Rẽ phải
- Rẽ trái
Mách nước:
Khi robot chạy tới thì 2 motor đều quay chiều thuận, 2 leds phát sáng màu xanh.
Khi robot chạy lui thì 2 motor đều quay chiều ngược, 2 leds phát sáng màu đỏ.
Khi robot rẽ phải thì motor phải quay chiều nghịch, motor trái quay chiều thuận (các leds
phát sáng màu tương ứng)
Khi robot rẽ trái thì motor trái quay chiều nghịch, motor phải quay chiều thuận



Để tải bản Đầy Đủ của tài liệu, xin Trả lời bài viết này, Mods sẽ gửi Link download cho bạn sớm nhất qua hòm tin nhắn.
Ai cần download tài liệu gì mà không tìm thấy ở đây, thì đăng yêu cầu down tại đây nhé:
Nhận download tài liệu miễn phí

Tóm tắt nội dung tài liệu:

Từng bước chế tạo Robot
Bài 1: Các bước chuẩn bị
Để bắt tay vào chế tạo 1 con Robot bạn cần
1. Kiến thức :
- Kiến thức cơ sở về điện tử: tui nghĩ rằng nếu đã tốt nghiệp PTTH thì kiến thức điện tử
của bạn đã có thể dùng để chế tạo 1 con Robot đơn giản.
- Kiến thức lập trình Vi điều khiển: bạn có thể học lập trình Assemble hay C.
2. Phần mềm:
- Trình duyệt: tùy mục đích làm Robot mà bạn sẽ chọn loại VĐK phù hợp, trên cơ sở đó
sẽ chọn trình duyệt tương ứng. Trong loạt bài này tui sẽ hướng dẫn Lập trình C cho VĐK
T89C51 trên trình duyệt RIDE 51. Trên cơ sở đó bạn có thể viết lại cho VĐK của mình
trên trình duyệt tương ứng.
- Phần mềm mô phỏng: Protues hỗ trợ rất mạnh về mô phỏng trực quan. Bạn sẽ thấy rất
tiện nghi khi làm việc với nó, tiết kiệm thời gian, và giảm chi phí mua những linh kiện không
cần thiết...
3. Phần cứng: nếu có tiền thì...
- Nếu là người chưa có kinh nghiệm về VĐK, bạn nên mua cho riêng mình 1 KIT để học,
có sẵn VĐK, LCD, speaker ... để tiết kiệm tiền, tránh và các cổng Analog và Digital để
cắm các thiết bị ngoài như sensor hay motor.
- 2 motor DC cỡ nhỏ.
- Sensor: 2 sensor hồng ngoại nhận dạng vạch trắng- đen, 1 sensor hồng ngoại xác định
khoảng cách.
*** tui mua tất cả những linh kiện này tốn hơn 2 triệu đồng.
- Ngoài ra bạn có thể mua thêm các linh kiện cần thiết cho mục đích của mình, ví dụ
sensor đo nhiệt độ, độ ẩm ...
*** Lời khuyên: bạn không nên vội mua bất cứ thứ linh kiện nào khi mà chưa thấy nó cần
thiết. Vì hầu hết các linh kiện đều có thể mô phỏng được.
Khi nào nắm chắc kiến thức và cảm giác thật sự cần thiết phải mua thì mới mua. Để dành
tiền cho những mục đích xa hơn. Còn nếu 2 triệu không là vấn đề lớn với bạn thì cứ mua.
4. Quan trọng nhất: là bạn thực sự thích thú về Robot và mong muốn tự mình có thể chế
tạo Robot.
5. Thời gian rảnh: Hãy sắp xếp thời gian học tập và nghỉ ngơi hợp lý để bạn có 1 khoảng
thời gian rảnh, yên tâm ngồi nghiên cứu về Robot. Đừng để nó ảnh hưởng đến kết quả
học tập hay công việc chính của bạn.
Bài 2: Lập trình điều khiển động cơ DC
2.1. Trong bài này, tui sẽ hướng dẫn thiết mạch, mô phỏng trên Proteus và viết chương
trình cho VĐK để điều khiển động cơ DC.
Khi làm thực tế lưu ý: Mạch điều khiển động cơ DC gồm 2 phần: mạch logic và mạch
công suất. Do mạch công suất có thể sử dụng điện áp cao, còn mạch logic thì dùng điện
áp thấp (dưới 5V), nên cần thiết phải cách ly 2 phần này ra để bảo vệ mạch logic. Có
nhiều phương pháp để giải quyết vấn đề này, trong đó có phương pháp dùng Opto và
dùng IC. Để đơn giản hóa, tui dùng IC L293D có tích hợp sẵn mạch khuyếch đại và cách
ly 2 mạch logic - công suất.
Xem mạch ở hình dưới
File gửi kèm
2.2. Driver cho mạch điều khiển động cơ này như sau:
/*--------------------------------------------------------------------------*/
// Program : Pulse width modulation by PCA module
// Description : Generate pulse width modulation signal on CEX3 and CEX4
// : using PCA function
// Filename : dc_motor.h
// C compiler : RIDE 51 V6.1
/*--------------------------------------------------------------------------*/
#define ch1 1 // Define constant
#define ch2 2 // Define constant
#define all 3 // Define constant
#define motor_pulse 115 // Define constant
sbit dir_a1 = P2^0; // bit drive motor0
sbit dir_a2 = P2^1; // bit drive motor0
sbit dir_b1 = P2^2; // bit drive motor1
sbit dir_b2 = P2^3; // bit drive motor1
/**************************************************
***************************/
/*********************** Drive motor backward
********************************/
/**************************************************
***************************/
void motor_bk(unsigned char select_bk ,unsigned char speed)
{
TMOD &= 0xF0; // Refresh mode timer 0
TMOD |= 0x02; // Setup mode timer 0 (8 bit auto reload)
TH0 = motor_pulse; // Reload value for timer 0
TL0 = motor_pulse; // Initial value for count of timer 0
TR0 = 1; // Start timer 0
CMOD = 0x04; // Set CMOD PCA count freq. by pulse overflow timer0
if(select_bk==1)
{
CCAPM3 = 0x42; // Set CCAP Module 3 as 8 bit PWM
CCAP3L = 255-speed; // Set CCAP3L initial value by speed variable(set duty cycle)
CCAP3H = 255-speed; // Set CCAP3H reload value by speed variable(set duty cycle)
dir_a1 = 1; // set direction backward
dir_a2 = 0; // set direction backward
}
else if(select_bk==2)
{
CCAPM4 = 0x42; // Set CCAP Module 3 as 8 bit PWM
CCAP4L = 255-speed; // Set CCAP4L initial value by speed variable(set duty cycle)
CCAP4H = 255-speed; // Set CCAP4H initial value by speed variable(set duty cycle)
dir_b1 = 1; // set direction backward
dir_b2 = 0; // set direction backward
}
CCON = 0x40; // Set PCA counter run
}
/**************************************************
***************************/
/*********************** Drive motor forward
********************************/
/**************************************************
***************************/
void motor_fd(unsigned char select_fd, unsigned char speed)
{
TMOD &= 0xF0; // Refresh mode timer 0
TMOD |= 0x02; // Setup mode timer 0 (8 bit auto reload)
TH0 = motor_pulse; // Reload value for timer 0
TL0 = motor_pulse; // Initial value for count of timer 0
TR0 = 1; // Start timer 0
CMOD = 0x04; // Set CMOD PCA count freq. by pulse overflow timer0
if(select_fd==1)
{
CCAPM3 = 0x42; // Set CCAP Module 3 as 8 bit PWM
CCAP3L = 255-speed; // Set CCAP3L initial value by speed variable(set duty cycle)
CCAP3H = 255-speed; // Set CCAP3H initial value by speed variable(set duty cycle)
dir_a1 = 0; // Set direction forward
dir_a2 = 1; // Set direction forward
}
else if(select_fd==2)
{
CCAPM4 = 0x42; // Set CCAP Module 3 as 8 bit PWM
CCAP4L = 255-speed; // Set CCAP4L initial value by speed variable(set duty cycle)
CCAP4H = 255-speed; // Set CCAP4H initial value by speed variable(set duty cycle)
dir_b1 = 0; // Set direction forward
dir_b2 = 1; // Set direction forward
}
CCON = 0x40; // Set PCA counter run
}
/**************************************************
***************************/
/*********************** Break motor
*****************************************/
/**************************************************
***************************/
void motor_stop(char select_stop)
{
if(select_stop==1)
{
dir_a1 = 0; // Break motor channel 1
dir_a2 = 0; // Break motor channel 1
CCAPM3 &= 0xFD; // Stop generate PWM at pin P1.6
}
else if(select_stop==2)
{
dir_b1 = 0; // break motor channel 2
dir_b2 = 0; // Break motor channel 2
CCAPM4 &= 0xFD; // Stop generate PWM at pin P1.7
}
else if(select_stop==3)
{
dir_a1 = 0; // Break motor channel 1
dir_a2 = 0; // Break motor channel 1
CCAPM3 &= 0xFD; // Stop generate PWM at pin P1.6
dir_b1 = 0; // Break motor channel 2
dir_b2 = 0; // Break motor channel 2
CCAPM4 &= 0xFD; // Stop generate PWM at pin P1.7
}
}
2.3. Đây là phần mô phỏng trên Proteus
Các thành phần chính gồm:
- AT89C51
- motor driver L293D
- 2 motor DC
- 2 leds hiển thị chiều quay động cơ: chiều thuận led sẽ cho ánh sáng xanh, chiều nghịch
led cho ánh sáng màu đỏ
File gửi kèm
2.4. Thực hiện bài tập điều khiển đơn giản nhất
Robot của bạn được điều khiển chuyển động bằng 2 động cơ DC, như mô phỏng ở trên.
Yêu cầu: Lập trình cho Robot thực hiện các chuyển động sau:
- Chạy tới
- Chạy lui
- Rẽ phải
- Rẽ trái
2.4. Thực hiện bài tập điều khiển đơn giản nhất
Robot của bạn được điều khiển chuyển động bằng 2 động cơ DC, như mô phỏng ở trên.
Yêu cầu: Lập trình cho Robot thực hiện các chuyển động sau:
- Chạy tới
- Chạy lui
- Rẽ phải
- Rẽ trái
Mách nước:
Khi robot chạy tới thì 2 motor đều quay chiều thuận, 2 leds phát sáng màu xanh.
Khi robot chạy lui thì 2 motor đều quay chiều ngược, 2 leds phát sáng màu đỏ.
Khi robot rẽ phải thì motor phải quay chi
Music ♫

Copyright: Tài liệu đại học © DMCA.com Protection Status