1
Robotics and Automation (EPM4066) Tutorial 3 (Inverse Kinematics) 1. Consider the link-coordinate diagram for the four-axis cylindrical-coordinate robot with tool roll motion as shown. Here the vector of joint variables is q , and the kinematic parameters are given in the table below. [ ] T d d 4 3 2 1 , , , θ θ = y 2 x 2 Axis θ d a α home 1 q 1 0 0 0 0 2 π/2 q 2 0 π/2 d 3 0 q 3 0 π/2 r 4 q 4 d 4 0 0 π z 2 a) Find the arm matrix T . ) (q tool base b) Solve the inverse kinematics equations by finding (in whichever order is easiest): i. The base angle q . 1 ii. The vertical extension . 2 q iii. The radial extension . 3 q iv. The tool roll angle q . 4 The tool pose is given in form of a homogenous transformation matrix. 2. Consider the link-coordinate diagram of the five-axis articulated robot Rhino XR-3: a 4 d 5 Solve the inverse kinematics equations using a geometric approach by finding the base angle , the shoulder angle q , the elbow angle q , the tool pitch angle and the tool roll angle (in whichever order is easiest). The tool pose is given in form of a homogenous transformation matrix. 1 q 5 q 2 3 4 q

Tutorial 3

Embed Size (px)

DESCRIPTION

vd

Citation preview

Page 1: Tutorial 3

Robotics and Automation (EPM4066) Tutorial 3 (Inverse Kinematics) 1. Consider the link-coordinate diagram for the four-axis cylindrical-coordinate robot with tool

roll motion as shown. Here the vector of joint variables is q , and

the kinematic parameters are given in the table below.

[ ]Tdd 4321 ,,, θθ=

y2 x2

z2

a) Find the arm matrix T . )(qtoolbase

b) Solve the inverse kinematics equations by finding (in wi. The base angle q . 1

ii. The vertical extension . 2qiii. The radial extension . 3qiv. The tool roll angle q . 4

The tool pose is given in form of a homogenous transf 2. Consider the link-coordinate diagram of the five-axis a

a4

Solve the inverse kinematics equations using a geometric, the shoulder angle q , the elbow angle q , the tool p

(in whichever order is easiest). The tool pose is

transformation matrix.

1q

5q2 3

Axis θ d a α home 1 q1 0 0 0 0 2 π/2 q2 0 π/2 d 3 0 q3 0 π/2 r 4 q4 d4 0 0 π

hichever order is easiest):

ormation matrix.

rticulated robot Rhino XR-3:

d5

approach by finding the base angle itch angle and the tool roll angle

given in form of a homogenous 4q