Khóa học dạy gì
Động học robot là bảy bài học trên Uno, chia thành ba chương:
- Robot bánh xe: hệ quy chiếu thế giới và hệ quy chiếu robot, phép quay đưa một điểm từ hệ này sang hệ kia, atan2 và việc gói góc, khoảng cách và phương vị, một số đo cảm biến đi qua hai hệ; dẫn động vi phân theo cả hai chiều (tốc độ bánh xe ra v, omega và bán kính quay, và một cung tròn ra hai tốc độ bánh xe), quay tại chỗ và giới hạn tốc độ bánh xe; đo hành trình bằng phương pháp điểm giữa, so sánh với vị trí thật của xe, và một mô phỏng Monte Carlo về trượt bánh xe cho thấy sai số lớn dần theo khoảng cách lũy thừa 1.5.
- Tay máy: động học thuận trên tay máy hai khớp, ý tưởng đầu tiên về Jacobian và vùng làm việc; động học nghịch với cả hai nghiệm khuỷu, tầm với và giới hạn khớp cùng một vòng đi về; di chuyển theo khớp và theo Descartes, một phép chia tỷ lệ thời gian bậc ba và một điểm kỳ dị.
- Dự án lớn: tay máy bàn bốn servo trên PCA9685 cầm bút và vẽ các đường thẳng, hình vuông và hình tròn bằng cách giải ba khớp mỗi 5 mm.
Mỗi chương kết thúc bằng một bài kiểm tra ngắn. Mở nó từ /learn.
Các mạch
Mỗi bài học chạy một sketch viết riêng cho khóa học:
- Xe đo động học (
kinrover): khung gầm 2WD trên L9110 (động cơ trái ở chân 5 và 6, phải ở 9 và 10), encoder khe của nó trên các chân ngắt, trái ở chân 3 và phải ở chân 2. Sketch đếm cả hai cạnh của mỗi khe: 40 mỗi vòng bánh xe, mỗi khe tương ứng 5.105 mm mặt sàn. - Tay máy hai khớp (
kinarm): servo vai 180 độ ở chân 5 và servo khuỷu 270 độ ở chân 6, trên nguồn 5 V riêng. Hai thanh dài 100 mm và 80 mm. Giá trị trực tiếp của mỗi servo là góc khớp của nó. - Tay máy biết vẽ (
kindraw): tay máy bốn servo trong thư viện dùng chung trên PCA9685 (SDA A4, SCL A5), đế, vai, khuỷu và càng kẹp ở kênh 0 đến 3.
Các sketch nhận lệnh gõ vào Serial Monitor. Gõ một từ lạ để xem danh sách. Phần kiểm tra đọc tốc độ của khung gầm, góc của từng servo khớp, càng kẹp, và những gì sketch in ra.
Khắc phục sự cố
- Xe cứ chạy mãi. wheels và arc chạy cho đến khi bạn gõ stop.
- Odometry không khớp với xe. Cũng đúng vậy: hướng đi nhảy theo từng bước 2,25 độ, tức một cạnh encoder. Nhấp vào khung xe để đọc vị trí thật của nó.
- ik báo mọi nghiệm đều cần một khớp vượt quá giới hạn. Mục tiêu nằm trong tầm với nhưng cần vai xuống dưới 0 hoặc khuỷu quá 135 độ. Chọn một điểm phía trên khớp vai.
- Cánh tay vẽ không chịu vẽ. Gõ grip trước, và giữ các mục tiêu cách cơ sở khoảng 70 đến 130 mm.
Related
Lập kế hoạch chuyển động động cơ bước cho các máy di chuyển theo đường thẳng, và Servo, solenoid và cơ cấu chấp hành cho bản thân các servo.