Thông báo

Collapse
No announcement yet.

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

Collapse
X
 
  • Lọc
  • Giờ
  • Show
Clear All
new posts

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

    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);
    }
    }

    }
    Attached Files

  • #2
    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

    Comment


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

      Comment


      • #4
        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

        Comment


        • #5
          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;

          Comment


          • #6
            Click image for larger version

Name:	srf05tma.gif
Views:	1
Size:	4.2 KB
ID:	1385299
            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 )

            Code:
            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
            Code:
            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

            Code:
            ext_int_edge(H_TO_L); // ngat canh xuong
            Code:
            #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 )
            Code:
            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

            Comment


            • #7
              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

              Comment


              • #8
                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 !!!

                Comment

                Về tác giả

                Collapse

                thieugiaanh2 Tìm hiểu thêm về thieugiaanh2

                Bài viết mới nhất

                Collapse

                Đang tải...
                X