Giải số bài toán động học ngược tay máy

[hikarusai]

Nguyên văn bởi kstn

Việc giải bài toán ngược tay máy theo phương pháp giải tích khá phức tạp(với các tay máy có bậc tự do lớn). Vì vậy người ta đã đưa ra các phương pháp giải số để giải nhanh bài toán dộng học ngược. Có 2 kiểu giải số bài toán động học ngược:
Cách thứ nhất, viết phương trình động học thuận x=f(q) rồi sử dụng lặp Newton-Raphson để giải phương trình này. PP này có chi phí tính toán lớn và kô phải lúc nào cũng hội tụ(phụ thuộc vào điều kiện đầu)
Cách thứ hai: sử dụng chuỗi Taylor và ma trận Jacobi để viết phương trình xấp xỉ toạ độ đầu ra. Từ phương trình xấp xỉ đó ta xây dựng thuật toán hội tụ tới nghiệm yêu cầu. Thuật toán hội tụ có 2 kiểu là sai phân tới và sai phân lùi. Sử dụng lược đồ sai phân tới khi muốn có kết quả nhanh, tuy nhiên sai số tích lũy sẽ khá lớn qua nhiều bước lấy mẫu(vì pp này kô cho kết quả chính xác theo yêu cầu cho trước). Sử dụng lược đồ sai phân lùi có thể cho kết quả chính xác tùy ý(có thể đạt tới 1e-12), tuy nhiên phải giải lặp tại từng bước lấy mẫu.
Sử dụng ma trận Jacobi và lược đồ sai phân lùi có thể cho kết quả chính xác cao đối với bài toán động học ngược(vị trí, vận tốc, gia tốc). Tôi đã sử dụng phương pháp này giải được các cơ cấu cánh tay máy phẳng
Với các cơ cấu cánh tay máy 3d(vd kuka). Việc áp dụng các thuật toán trên có một số khó khăn, đơn cử như nếu sử dụng tọa độ Euler để mô tả góc quay trong không gian thì sẽ bị suy biến khi ma trận cosin chỉ hướng là đơn vị, vì vậy thuật toán kô hội tụ ngay tại bước lặp đầu tiên. Để giải quyết khó khăn này, tôi đã đề ra một giải thuật lặp mới, xây dựng lại ma trận Jacobi với ngõ ra là 12 biến(3 toạ độ + 9 chỉ phương). Kết quả tính rất tốt với trường hợp robot 6 dof(kuka).
Hiện nay, tôi đang gặp rắc rối với bộ data để thí nghiệm, có bạn nào có bộ data ngõ ra (tọa độ + các vector chỉ phương) hay có bộ mô phỏng hay training robot nào có xuất ra các data đó thì hãy chỉ cho tôi.
Sư huynh nào có cao kiến hay đóng góp gì xin hãy giúp đỡ.

Sư huynh pro quá có thể gửi cho đàn em tham khảo với. em sử dụng phương pháp thứ 2 nhưng chạy hoài không ra.

[kstn]

Đoạn code đính kèm mô tả các bước thuật toán trong matlab. Hiện nay tôi khuyên dùng thư viện roboop vì nó hỗ trợ thuật toán này + qui ước Denavit-Hatenberg. Roboop có thể giải bài toán động lực học

[kstn]

Đính kèm là demo sử dụng roboop để mô hình cánh tay máy kuka 6 dof. Dùng phím 'i' 'o' để zoom, nhấn chuột phải để chọn khớp, dùng '[' ']' để thay đổi giá trị từng khớp. Hiện nay tôi tạm dừng dự án này vì kô có bài toán cụ thể nào để áp dụng. Ai có ý tưởng gì hay xin hãy đóng góp

[conso0]

Nguyên văn bởi kstn

Đính kèm là demo sử dụng roboop để mô hình cánh tay máy kuka 6 dof. Dùng phím 'i' 'o' để zoom, nhấn chuột phải để chọn khớp, dùng '[' ']' để thay đổi giá trị từng khớp. Hiện nay tôi tạm dừng dự án này vì kô có bài toán cụ thể nào để áp dụng. Ai có ý tưởng gì hay xin hãy đóng góp

Bạn thử cho Robot của bạn vẽ ra một chữ gì đó hay một bông hoa hay 1 hình kỳ thú gì đó trên một mặt phẳng xem....

[kstn]

Thêm 1 demo bổ sung một số chức năng tương tác (điều khiển end effector) (chi tiết xem file manual)

[kebitmat_f]

Nguyên văn bởi kstn

Thêm 1 demo bổ sung một số chức năng tương tác (điều khiển end effector) (chi tiết xem file manual)

sao minh chay toan bi loi nhi? ko bit la vi sao?

[hikarusai]

Nguyên văn bởi kstn

Đoạn code đính kèm mô tả các bước thuật toán trong matlab. Hiện nay tôi khuyên dùng thư viện roboop vì nó hỗ trợ thuật toán này + qui ước Denavit-Hatenberg. Roboop có thể giải bài toán động lực học

Em mới biết tí chút về matlab. Đại ca có tài liệu về Roboop up lên diễn đàn cho anh em học hỏi với.Thanks trươc.