Kinematics. Basilio Bona. Semester 1, DAUIN Politecnico di Torino. B. Bona (DAUIN) Kinematics Semester 1, / 15

Transcription

1 Kinematics Basilio Bona DAUIN Politecnico di Torino Semester 1, B. Bona (DAUIN) Kinematics Semester 1, / 15

2 Introduction The kinematic quantities used to represent a body frame are: position (of the origin) x, linear velocity ẋ, linear acceleration ẍ, orientation (of the frame) α, angular velocity ω, angular acceleration ω. With α one indicates the generic angular parameters associated to the body frame orientation, e.g., Euler or RPY angles. Other parametrizations are possible, but they are more complex to deal with. One must use ω for the angular velocity instead of the time derivative α of the orientation angles: in kinematic equations it is necessary to use the true angular velocity vector. Notice that ω is a physical vector while α has no physical meaning (what represents the sum α 1 + α 2?). If α is required, there are relations from ω to α and vice-versa. B. Bona (DAUIN) Kinematics Semester 1, / 15

3 Kinematics: position equations The motion equations are described by two vectorial equalities x(t) = g x (q(t),λ,t) α(t) = g α (q(t),λ,t) where λ is a vector of (usually constant) parameters that characterize the system from a geometrical, physical or structural point of view. If one uses the pose vector p(t) T = [ x T (t) α T (t) ] the direct position kinematic function is given by a nonlinear equation [ ] gx ( ) DPKF: p(t) = g(q(t),λ,t) where g( ) = g α ( ) and the inverse position kinematic function, is given by the inverse nonlinear relation IPKF: q(t) = g 1 (p(t),λ,t) This equation is in general much more difficult to solve, since it requires the inversion of nonlinear trigonometric functions. B. Bona (DAUIN) Kinematics Semester 1, / 15

4 Kinematics: velocity equations One can express both the linear velocities ẋ(t) and the angular velocities α(t) of the rigid body as functions of the generalized velocitie q(t), obtaining the direct linear velocity kinematic function ẋ(t) d dt g x(q(t),λ,t) = J L (q(t),λ,t) q(t)+ g x(q(t),λ,t) t and the direct angular velocity kinematic function α(t) d dt g α(q(t),λ,t) = J A (q(t),λ,t) q(t)+ g α(q(t),λ,t) t The derivative α is in general not equal to the angular velocity ω, as we will see below. B. Bona (DAUIN) Kinematics Semester 1, / 15

5 Kinematics: velocity equations The matrix J L is called the linear Jacobian matrix [ ] [J L ] = gxi (q(t),λ,t) ij q j (t) The matrix J A [ ] [J A ] = gαi (q(t),λ,t) ij q j (t) is called the angular Jacobian matrix B. Bona (DAUIN) Kinematics Semester 1, / 15

6 Kinematics: velocity equations When the above functions do not explicitly depend on time t, we obtain a simplified form ẋ(t) = J L (q(t),λ) q(t) or simply ẋ = J L (q) q and α(t) = J A (q(t),λ) q(t) or simply α = J A (q) q We observe that the two relations are linear in the velocities, since they are the product between the Jacobian matrices and the generalized velocities q i (t). We also observe that the Jacobian matrices are, in general, time varying, since they depend on the generalized coordinates q(t). B. Bona (DAUIN) Kinematics Semester 1, / 15

7 Kinematics: velocity equations Embedding ẋ and α in a single vector, we can write [ẋ(t) ] ṗ α (t) = or equivalently ṗ α(t) α (t) = [ ] v(t) α(t) The quantity ṗ takes the name of generalized velocity and is not a vector, since the time derivatives of the angular velocities are different from the components of the physical angular velocity vector ω. When we use the true geometrical angular velocity ω, we write [ ] [ ] ẋ(t) v(t) ṗ ω (t) = or equivalently ṗ ω(t) ω (t) = ω(t) this vector [ v(t) ω(t) ] T is also called a twist. B. Bona (DAUIN) Kinematics Semester 1, / 15

8 Kinematics: velocity equations We can now write in a compact form the kinematic function of the generalized velocities: ṗ(t) d g(q(t),λ,t) = J(q(t),λ)dq(t) + g(q(t),λ,t) dt dt t where the Jacobian J is a block matrix composed by J L and J A [ ] JL (q(t),λ) J(q(t),λ) = J A (q(t),λ) If the kinematic position function g does not explicitly depend on time, we can write ṗ(t) = J(q(t),λ) q(t) or simply ṗ = J q B. Bona (DAUIN) Kinematics Semester 1, / 15

9 Kinematics: velocity equations As we will detail below, when the generalized velocity is expressed using the angles derivative ṗ α, then ṗ α = J α q and when the generalized velocity is expressed using the angular velocity ṗ ω, then ṗ ω = J ω q B. Bona (DAUIN) Kinematics Semester 1, / 15

10 This relation can be inverted only when the Jacobian is non-singular, i.e., detj(q(t)) 0 In this case, if the kinematic equations do not depend on time, we have what we call the inverse velocity kinematic function q(t) = J(q(t),λ) 1 ṗ(t) or simply q = J 1 ṗ The Jacobian depends on the generalized coordinates q i (t), and it can become singular for particular values of these coordinates; we say in this case that we have a singular configuration or a kinematic singularity. The coordinates q sing that produce the singularity are called singular configurations detj(q sing ) = 0 The kinematic singularity problem is not treated in this course, but is very important in robotics. B. Bona (DAUIN) Kinematics Semester 1, / 15

11 Angular velocity transformations Euler angles If α(t) are the angular parameters (Euler angles, RPY angles, etc.), the analytical derivative α(t) is called analytical (angular) velocity. The analytical derivative α does not necessarily coincide with the physical angular velocity vector ω, and the second derivative α does not necessarily coincide with the physical angular acceleration vector ω. Let us assume that the orientation is described by the Euler angles α E = [ φ(t) θ(t) ψ(t) ] T ; the analytical angular velocity (Eulerian velocity) is then φ(t) α E (t) = θ(t) ψ(t) The Eulerian velocity α(t) is transformed into the geometrical (angular) velocity by the following relation ω(t) = b φ φ + b θ θ + b ψ ψ, B. Bona (DAUIN) Kinematics Semester 1, / 15

12 Angular velocity transformations Euler angles Where b φ = 0 0, b θ = cosφ(t) sinφ(t), b ψ = sinφ(t)sinθ(t) cosφ(t)sinθ(t) 1 0 cosθ(t) and we can define the transformation between α E (t) and ω(t) introducing a square matrix φ ω(t) = M E (t) θ = M E (t) α E (t) ψ The transformation matrix 0 cosφ sinφ M E (t) = 0 sinφ cosφ sinθ 1 0 cos θ is NOT a rotation matrix and depends only on φ(t) and θ(t). B. Bona (DAUIN) Kinematics Semester 1, / 15

13 Angular velocity transformations Euler angles When detm E (t) = sinθ = 0 the matrix is singular. The inverse is sinφ cosθ cosφ cosθ 1 sinθ sinθ E (t) = cosφ sinφ 0 sinφ cosφ 0 sinθ sinθ M 1 B. Bona (DAUIN) Kinematics Semester 1, / 15

14 Angular velocity transformations RPY angles For the RPY angles α RPY = [ θ x θ y θ z ] T we have where ω (t) = M RPY (t) α RPY (t) cosθ z cosθ y sinθ z 0 M RPY (t) = sinθ z cosθ y cosθ z 0 sinθ y 0 1 For small angles we can approximate c i 1, s i 0 obtaining M RPY I; in this case ω(t) α RPY (t). B. Bona (DAUIN) Kinematics Semester 1, / 15

15 Angular velocity transformations RPY angles When detm RPY (t) = cosθ y = 0 the matrix is singular. The inverse is RPY (t) = M 1 cosθ z sinθ z 0 cosθ y cosθ y sinθ z cosθ z 0 cosθ z sinθ y cosθ y sinθ z sinθ y cosθ y 1 B. Bona (DAUIN) Kinematics Semester 1, / 15

16 Analytical and Geometrical Jacobians According to the type of angle related velocity, we have two types of angular Jacobians. If we use α, then If we use ω, then J α is called the Analytical Jacobian. J ω is called the Geometrical Jacobian. α = J α q (1) ω = J ω q (2) The relation between the two Jacobians is given by a linear transformation J ω = M(q)J α (3) where M = M E or M = M RPY B. Bona (DAUIN) Kinematics Semester 1, / 15