Giáo trình robot part 8

M06 = M01M12M23 ... M56 = M05M56 Các ma trận quay ở biểu thức (3.30) được xác định theo các công thức (3.28) khi ta thiết lập được các ma trận quay M01, M12, M23, M34, M45, M56. Do các cặp hệ trục toạ độ kế tiếp có một trục toạ độ trùng nhau hoặc song song với nhau, ta có thể nhanh chóng xác định các ma trận quay nói trên. cosϕ21 - sin ϕ21 M12 = M’21 = sin ϕ21 0 cos ϕ21 0 0 0 1 (3.31)