Bài 13:Thuật toán nhận biết ngã tư và đếm ngã tư

Ý nghĩa thuật toán:
Khi robot do đường trên sân thi đấu nó không chỉ đi thẳng mà còn rẻ phải rẻ trái .v.v. Khi robot chuyển hướng thì thường nó phải tìm một ngã tư để tiếp tục dò đường sau khi quay. Vậy làm sao để robot nhận biết được nó đang đứng tại một ngã tư và ngã tư đó là ngã tư thứ mấy? Ta có thuật toán đếm ngã tư.



Nhìn vào hình vẻ này ta thấy muốn robot nhận biết được ngã tư thì số cảm biến dò đường nằm trên vạch trắng sẻ lớn hơn 3, vì vạch trắng theo chiều dọc chỉ đủ để chứa 2 cảm biến, robot gặp ngã tư tức là các cảm biến cùng nằm trong vạch trắng ngang.

Vậy để kiểm tra robot có nằm trên ngã tư không ta chỉ cần kiểm tra một tổ hợp trên 3 cảm biến trong 8 cảm biến nhận vạch trắng.
Ví dụ: Nếu cổng P0 được nối tới các cảm biến thì ta kiểm tra giá trị cổng P0, nếu P0 = 00011100 tức là có ba cảm biến nhận vạch trắng như vậy robot đã bắt được 1 ngã tư. Ta dùng một biến để kiểm tra ngã tư là co_nga_tu.
Nếu muốn di chuyển tới ngã tư thứ mấy thì ta dùng một biến để lưu số ngã tư đã đi qua, mỗi lần qua ngã tư thì biến này tăng lên 1 chẳng hạn, và chỉ cần kiểm tra biến này bằng bao nhiêu thì ta xác định được ngã tư robot đang đến là ngã tư thứ mấy.
Chương trình kiểm tra ngã tư đơn giản: kiểm tra tổ hợp 3 trên 4 cảm biến ở giửa của robot.


void kt_nga_tu(void)
{
  ACC=P0;                              // Nhận giá trị cảm biến ở cổng P0 vào thanh ghi ACC
  if(ACC==00111000)             // trường hợp 3 mắt nhận
    {
co_nga_tu=1;               // đã có ngã tư 
    }
  else if(ACC==00110100)      // trường hợp 3 mắt nhận
    {
            co_nga_tu=1;
    }
  else if(ACC==00101100)      // trường hợp 3 mắt nhận
    {
            co_nga_tu=1;
    }
  else if(ACC==00011100)      // trường hợp 3 mắt nhận
    {
            co_nga_tu=1;
    }
  else if(ACC==00111100)      // trường hợp 4 mắt nhận
    {
            co_nga_tu=1;
    }
   else
     do_duong();                        // nếu không gặp ngã tư thì gọi hàm dò đường trên vạch //trắng dọc
}

Chương trình chính của chúng ta sẻ như sau: Chẳng hạn ta viết chương trình cho robot chạy tới ngả tư thứ 3 rồi thực hiện thao tác rẻ trái.
void main(void)
{
  bit dem_so_nga_tu=0;                        // khai bao bien đếm ngã tư
  bit co_nga_tu=0;                                // khai báo biến cờ ngã tư =0
 while(dem_nga_tu!=3)             // trong khi chưa đủ 3 ngã tư
  {
     kt_nga_tu();                         // gọi hàm kiểm tra ngã tư để kiểm tra ngã tư
     if(co_nga_tu==1)                             // nếu đã gặp ngả tư
    dem_so_nga_tu++;                           // tăng giá trị đếm ngã tư lên

  }
    re_trai();                                           // gọi hàm rẻ trái để thực hiện thao tác rẻ trái
}






Blog Điện Tử | Tin Học
In bài này
Previous
Next Post »

Bạn đọc hãy giúp chúng tôi xây dựng cộng đồng bằng cách để lại bình luận, chúng tôi luôn đón nhận mọi ý kiến của các bạn:
» Bình luận nghiêm túc và không chứa các liên kết quảng cáo.
» Vui lòng không Spam nhận xét với mọi hình thức.
» Rất mong bạn đề tên cho nhận xét của chính mình - Bằng cách chọn vào Tên/URL và điền tên bạn vào (Phần URL có thể bỏ trống ).

- Bạn có thể chèn Link nhạc (NCT), video(Youtube),Hình ảnh vào comment bằng cú pháp:
+ [youtube] Link video Youtube [/youtube].
+ [img] Link ảnh( định dạng PNG, JPG,GIF) [/img]
+Chèn link liên kết: <a href="LINK" rel="nofollow">Name</a>
-Bạn copy mã bên cạnh biểu tượng chèn vào nhận xét để bày tỏ cảm xúc!! ConversionConversion EmoticonEmoticon

       Mạch Khóa Số Điện Tử Mạch Đếm Sản Phẩm Mạch Đèn giao thông Ngã Tư Mạch Trái Tim Final Mạch Trái Tim Final Mạch Trái Tim I Love U

THƯ MỤC KHO TÀI LIỆU MIỄN PHÍ ECHIPKOOL

Code 8051 - ASM Code 8051 - C Code AVR - C Code led sao băng Code PIC - C Điện tử cơ bản điện tử viễn thông Đo Nhiệt Độ DS18B20 + LCD Đo Nhiệt Độ LM35 + LCD Đo Nhiệt Độ LM35 + Led 7 thanh Đo tốc độ động cơ Động cơ robo Ebook Đại Học ebook điện tử Ebook đồ án Học Orcad Học Protues Hồng ngoại Lập Trình 8051 Lập Trình AVR lập trình c++ Lập Trình Led Quảng Cáo lập trình PIC Lập trình Robot Lập trình VHDL Lcd16x2 Led Clock Led Quay Led RGB Mạch 7seg Mạch Amply.Mạch Loa Mạch Cảm Biến Mạch cube Mạch Đếm Sản Phẩm Mạch điện cơ bản Mạch điện hay Mạch Điện Ứng Dụng Mạch đọc file nhạc MP3 dùng Atmega 8 Mạch Động Cơ Mạch đồng hồ Mạch đồng hồ LCD Mạch đồng hồ Matrix Mạch giao thông Mạch in Mạch khóa số điện tử Mạch Led đơn Mạch Led Quảng Cáo Mạch Led Vumeter Mạch Ma trận Phím Mạch Matrix Mạch nạp Mạch nguồn Mạch Nút Bấm Mạch RS232 Mạch RS485 Mạch thu phát Mạch tổ hợp MSI Mạch trái tim Mạch truyền điện không dây Mạch Vi điều khiển Module Bluetooth Module Sim Module Sim548 Motor Nhiệt độ - Độ ẩm oscilloscope Phần mềm điện tử Phần Mềm Diệt Viruts Phần Mềm Hay Phần Mềm Led Quảng Cáo Phần mềm vi tính robocon Rule robocon Sạc Acquy Sản Phẩm Thương Mại Sáng tạo Smart Home Tài liệu Điện Tử Tranzitor Tụ điện TUT - 8051 - ASM TUT - 8051 - KeilC UART Ứng Dụng Led Quảng Cáo Ứng dụng USB USB TO COM Vi điều khiển - Ứng dụng Vi mạch số VOM Wifi ESP8266