Xin giúp đỡ về mạch SRF05

[thieugiaanh2]

Mình đang làm mạch SRF05 đo khoảng cách điều khiển động cơ DC. Mình tìm đc sơ đồ mạch SRF05 mà thấy chân out của SRF05 ko thấy nối vào chân gì của Pic cả, có ai bik chỉ giúp mình với . Sẵn giải thích giùm mình cái code lun .Cảm ơn rất nhìu .
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);
}
}

}

[motkiepvuvo]

SRF05 có 2 mode: ở đây dùng mode1 (bạn xem ở đây SRF05 Technical Documentation)
-ở mode này triger chỉ cần nối vào chân I/O bình thường của Pic
-Echo là chân phản hồi về nối vào chân ngắt INT hoặc capture CCP1 của pic : mục đích là đo chiều dài xung trả về ( tốt nhất nên dùng chân CCP1 - dùng chức năng capture bắt cạnh lên và xuống của xung )
-Chân còn lại để trống

[thieugiaanh2]

bạn có thể giúp mình giải thích cái code ở phía trên được không?

[motkiepvuvo]

về code thì về cơ bản thì theo nguyên tắc dùng timer đo chiều dài của xung trả về trên chân Echo để quy ra khoảng cách
quãng đường đi của sóng siêu âm tới vật cản là 2s, với thời gian t (đo được ở timer) , vận tốc khoảng 344 m/s =>> suy ra s

[thieugiaanh2]

Cho mình hỏi cái phần này là sao vậy?
time_us=num_pulse/6;
distance=time_us/58;
num_pulse=0;
range_ok=0;
return distance;

[motkiepvuvo]

bạn phải hiểu nguyên lý làm việc của cảm biến trước, theo giản đồ hoạt động :
để đo được khoảng cách bằng cảm biến, ta cần kích 1 xung lên chân triger (>10us )

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.

sau đó cảm biến sẽ phát ra sóng siêu âm. ngay tại thời điểm phát sóng , chân Echo của cảm biến sẽ lên mức High , để phát hiện ra cạnh lên này
đoạn code trên sử dụng

while (!(input(SRF05_ECHO)))
			; // Doi cho den khi chan ECHO duoc keo len cao

ngay lúc này ta sẽ cài đặt timer1 =0 và bắt đầu cho timer đếm ; đồng thời cho phép ngắt ngoài tại chân echo để phát hện cạnh xuống

khi sóng siêu âm dội về tới cảm biến, chân ECHO sẽ xuống mức Low, để phát hiện ra cạnh xuống này ta dùng ngắt ngoài

ext_int_edge(H_TO_L); // ngat canh xuong

#INT_EXT
void Ngat_Ngoai(void) {
	disable_interrupts(GLOBAL);
	num_pulse += get_timer1();
	range_ok = 1;
	enable_interrupts(GLOBAL);
}

khi có ngắt ta disable_interrupts; đọc giá trị từ timer1 , giá trị này là num_pulse: số đếm timer tính từ cạnh lên đến cạnh xuống của Echo

theo như code này thì 1us , timer đếm được 60 giá trị(??? không chắc lắm :v) ( số giá trị này phụ thuộc vào chọn tần số clock và hệ số chia )

setup_timer_1(T1_INTERNAL | T1_DIV_BY_1); //F_TIMER1=F_OSC/4

Tính toán giá trị:
thời gian cả đi lẫn về của sóng siêu âm = số đếm được của timer1 chia cho 60

time_us = num_pulse / 6 (đơn vị us/10 ???);

2* distance = vận tốc * thời gian = 344 * time_us/1000

>>> distance = time_us / 5,8

hy vọng bạn làm được

[thieugiaanh2]

cảm ơn nhé để mình làm thử nếu có vấn đề j thì mình làm phiền bạn chỉ mình nhé. Cảm ơn bạn nhìu

[fire_tech]

Mấy anh chị cho em hỏi con SRF05 này điều khiển bởi 89v51rd2 thì sao ạ, ai có đoạn code nào không cho em xin với ạ, đang cần vụ này !!!