Bài tập này tập trung vào Ma trận Jacobi, mô phỏng giải quyết tỷ lệ
kiểm soát, và tĩnh nghịch đảo cho phẳng 3-Sở Tài chính, 3R robot. (Xem Hình 3.6 và 3.7; các
. Các thông số DH được đưa ra trong hình 3.8)
Phương pháp điều khiển giải quyết tỷ lệ [9] dựa vào vận tốc phương trình thao túng
KX = KJE nơi kj là ma trận Jacobian, e là vector của các doanh tương đối tỷ giá, KX là
các vector vận tốc của Descartes chỉ huy (cả tịnh tiến và quay), và k
là khung của biểu thức cho các ma trận Jacobian và vận tốc của Descartes. Con số này
cho thấy một sơ đồ khối để mô phỏng các thuật toán điều khiển giải quyết tỷ lệ:
Như được nhìn thấy trong hình, các thuật toán giải quyết tỷ lệ tính toán yêu cầu
giá khớp lệnh để cung cấp các tốc độ Descartes huy Xc; này
sơ đồ phải được tính toán tại mỗi bước thời gian mô phỏng. Những thay đổi ma trận Jacobian
với cấu hình cho các mục đích mô phỏng, giả định rằng các góc commandedjoint
luôn trùng với góc độ doanh thực tế đạt được, 0A (một kết quả hiếm khi thực sự trong
thế giới thực). Đối với các phẳng 3-Sở Tài chính, 3R Robot được giao, các phương trình vận tốc KX = kJ®
cho k = 0 là
nơi s123 = sin (91 + 02 + 03), C123 = cos (01 + 09 + 03), và như vậy. Lưu ý rằng 0X cho
vận tốc của Descartes về nguồn gốc của các khung tay (ở trung tâm của gắp trong
Hình 3.6) về nguồn gốc của khung cơ sở {0} với, thể hiện trong {0} phối.
Bây giờ, hầu hết các robot công nghiệp lệnh caimot trực tiếp, vì vậy chúng ta phải đầu tiên tích hợp
những giá chung thân chỉ huy các góc doanh chỉ huy có thể được
chỉ huy với robot ở mỗi bước thời gian. Trong thực tế, việc tích hợp đơn giản nhất
chương trình hoạt động tốt, giả sử một bước thời gian điều khiển nhỏ 0new = 0oId + Trong của bạn
mô phỏng giải quyết tỷ lệ MATLAB, giả định rằng các chỉ huy có thể đạt được
hoàn hảo bởi các robot ảo. (Chương 6 và 9 động hiện tại và tài liệu kiểm soát
mà chúng tôi không phải làm cho giả định đơn giản hóa này.) Hãy chắc chắn để cập nhật các
ma trận Jacobian với cấu hình mới ° mới trước khi hoàn thành việc giải quyết tỷ lệ
tính toán cho các bước tiếp theo thời gian.
Phát triển một chương trình MATLAB để tính toán ma trận Jacobian và mô phỏng
kiểm soát giải quyết tỷ lệ cho robot 3R phẳng. Với robot độ dài L1 = 4, = 3,
và L3 = 2 (in); các góc độ doanh ban đầu 0 = 93} T = {10 ° 200 300} T và
liên tục giá Descartes chỉ huy = {i = {0.2 -0.3 _0 • 21T (mis,
mis, rad / s), mô phỏng cho chính xác 5 giây, sử dụng các bước thời gian chính xác dt = 0,1 giây. Trong
vòng lặp cùng một chương trình, tính toán nghịch tĩnh học vấn đó là, tính toán
mô men doanh T = {r1 r2 r3} T (Nm), được đưa ra liên tục chỉ huy cờ lê Descartes
° {W} {ff, 1Z} T = { 1 2 31T (N, N, Nm). Ngoài ra, trong cùng một vòng lặp, sinh động các robot
để màn hình trong mỗi bước thời gian, do đó bạn có thể xem các chuyển động mô phỏng để xác minh
điều đó là đúng.
đang được dịch, vui lòng đợi..
