Thiết lập phương trình động học của tay máy robot - Bước 1: Gắn hệ toạ độ lên các khâu: Mô hình cánh tay robot và các hệ trục tọa độ. Đối với robot loại này các trục khớp đều song song với nhau, các hệ toạ độ đặt tại các tâm trục khớp. Khâu thứ hai có O2 đặt tại tâm trục khớp ba và z2 hướng về phía các khâu như hình vẽ. + Khâu 1: Có O1 đặt trên trục khớp thứ hai và có x1 hướng từ trục khớp thứ hai đến trục khớp thứ ba và.