PIC Vietnam

Go Back   PIC Vietnam > Các Đề Tài > Các đề tài khác

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

 
 
Ðiều Chỉnh Xếp Bài
Prev Previous Post   Next Post Next
Old 23-09-2013, 09:52 PM   #1
thieugiaanh2000
Nhập môn đệ tử
 
Tham gia ngày: Dec 2012
Bài gửi: 2
:
Giải thích dùm mình cái code

Mình đang làm đề tài điều khiển động cơ DC sử dụng cảm biến siêu âm SRF05. Mình kiếm được cái code mình chưa hiểu. Có bạn nào làm đề tài này rùi giúp mình với
Code:

#include <main.h>
#include <var.h>
#include "lcd.c"
#define SRF05_TRIGGER1 PIN_B1
#define SRF05_TRIGGER2 PIN_B2
#define SRF05_TRIGGER3 PIN_B3
#define SRF05_ECHO PIN_B0
#define NO_OBJECT 0
#INT_EXT
void Ngat_Ngoai(void)
{
disable_interrupts(GLOBAL);
num_pulse+=get_timer1();
range_ok=1;
enable_interrupts(GLOBAL);
}
#INT_TIMER1
void Ngat_Timer1(void)
{
disable_interrupts(GLOBAL);
num_pulse+=0xffff;
enable_interrupts(GLOBAL);
}
void SRF05_StartRange()
{
while(!range_ok)
{
output_high(SRF05_TRIGGER1);
delay_ms(15); // Phai tao 1 xung len co do lon it nhat 10ms
output_low(SRF05_TRIGGER1); // Bat dau phep do.
while(!(input(SRF05_ECHO))); // Doi cho den khi chan ECHO duoc keo len cao
set_timer1(0);
enable_interrupts(GLOBAL);
delay_ms(50);
}
}
float32 SRF05_GetDistance()
{
float32 time_us=0,distance=0;
SRF05_StartRange();
disable_interrupts(GLOBAL);
if(num_pulse>180000)
{
num_pulse=0;
range_ok=0;
return NO_OBJECT;
}
else
{
time_us=num_pulse/6;
distance=time_us/58;
num_pulse=0;
range_ok=0;
return distance;
}
}
void main()
{
unsigned char str[20],i=0;
float32 range;
output_float(SRF05_ECHO);
output_drive(SRF05_TRIGGER1);
output_drive(SRF05_TRIGGER2);
output_drive(SRF05_TRIGGER3);
LCD_Init();
sprintf(str,"DO AN 2");
delay_ms(10);
LCD_Puts(str);
delay_ms(1000);
LCD_Clear();
sprintf(str,"NGUYEN HOANG ANH");
LCD_Gotoxy(1,0);
LCD_Puts(str);
port_b_pullups (TRUE);
ext_int_edge(H_TO_L); // ngat canh xuong
setup_timer_1(T1_INTERNAL|T1_DIV_BY_1);//F_TIMER1=F_OSC/4
enable_interrupts(INT_TIMER1);
enable_interrupts(INT_EXT); // kich hoat ngat ngoai
disable_interrupts(GLOBAL);
while(TRUE)
{
range=SRF05_GetDistance();
if(range==NO_OBJECT)
{
LCD_Gotoxy(0,1);
sprintf(str,"Khong Co Vat Can");
LCD_Puts(str);
delay_ms(500);
}
else
{
LCD_Gotoxy(0,1);
sprintf(str,"Dis : %3.2f Cm ",range);
LCD_Puts(str);
}
}

}
File Kèm Theo
File Type: pdf PIC16F877A-SRF05-LCD16x2.pdf (11.0 KB, 6 lần tải)
thieugiaanh2000 vẫn chưa có mặt trong diễn đàn   Trả Lời Với Trích Dẫn
 


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à 07:38 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