Bài 12:Các thao tác cơ cấu

Chức năng: điều khiển các cơ cấu của robot thực hiện các thao tác nhằm ghi điểm với các cấu kiện.
            Ví dụ: khi robot muốn đặt cấu kiện vào kim tự tháp chẳng hạn, nó phải thực hiện một số thao tác như, đẩy cấu kiện và đúng vị trí, đặt cấu kiện xuống.v.v.
Ở đây ta mô phỏng thao tác kéo xuống để đưa cấu kiện xuông.
Thuật toán:



Giải thích cho thuật toán:
-         Chọn chiều thao tác: muốn robot thao tác kéo lên hay xuống thì đầu tiên là chọn chiều quay của động cơ.
-         Nạp thời gian thực hiện thao tác: Thông thường để kiểm tra một thao tác thực hiện được kết thúc khi nào thf người ta sử dụng các công tắc hành trình như đã nói ở trên, nhưng để an toàn hơn trong trường hợp công tắc hành trình có thể hỏng do va đập nhiều, ta có thể tính toán khoảng thời gian thực hiện thao tác để kết thúc thao tác trong trường hợp công tắc bị hỏng. Khoảng thời gian tính toán phải đủ để lớn hơn thời gian chạm công tắc hành trình, vì ưu tiên kiểm tra công tắc hành trình trước.
-         Chạy cơ cấu: Cấp nguồn cho động cơ thực hiện thao tác hạ cơ cấu để bỏ cấu kiện vào vị trí.
-         Giảm thời gian thực hiện: đồng thời với việc thao tác, giảm thời gian thực hiện xuống.
-         Kiểm tra : Nếu đã chạm công tắc hành trình: tức là cơ cấu đã đưa cấu kiện đến đúng vị trí cần để, nạp thời gian thực hiện về 0 và kết thúc thao tác. Nếu chưa chạm công tắc thì kiểm tra thời gian thực hiện.
-         Kiểm tra : Nếu thời gian thực hiện đã bằng 0 thì dừng thao tác và kết thúc. Nếu thời gian thực hiện còn lớn hơn 0 thì tiếp tục thực hiện bước chạy cơ cấu.
Chương trình cho một thao tác:

void keo_xuong(void)
{
 KEO_ROLE=0;                                   // chọn chiều động cơ
 KEO_MOTOR=80;                              // nạp tốc độ động cơ
 CT_KEOXUONG=1; 
int thoi_gian_thuc_hien=1000;            // nạp thời gian thực hiện
while(thoi_gian_thuc_hien!=0)            // trong khi chua het thoi gian   
    {
     if(CT_KEOXUONG==1)                  // đã chạm công tắc hành trình
           {
thoi_gian_thuc_hien==0;
                            // nạp thời gian thực hiện bằng 0 để kết thúc thao tác
           }
      else                                             
          thoi_gian_thuc_hien--;          // giảm thời gian thực hiện xuống 
               }
      KEO_MOTOR=0;                          // dừng động 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