1.11k likes | 1.54k Views
Basic Kinematics. Nattee Niparnan. Recall. Robot Programming Introduction to Control PID Motion Planning. Kinematics. Physical representation of manipulator Description of robotics entity Forward kinematics Inverse kinematics. Motivation. Robot acts in the real world
E N D
Basic Kinematics NatteeNiparnan
Recall • Robot Programming • Introduction to Control • PID • Motion Planning
Kinematics • Physical representation of manipulator • Description of robotics entity • Forward kinematics • Inverse kinematics
Motivation • Robot acts in the real world • We must know how robot interact with the real world • Where it is? • Where is its arm, upper arm, forearm, hand, etc. • How to reach to some position • Today, In static setting
What you will learn today • How to know the position of the robotic body? • Is that hard?
Today’s Protagonist • Manipulator
Robot Component • Links • Joints • End Effector
Link Something that connects joins
End Effector The last part of the robot
The Question: reprise • Where is my End Effecter? • Where are my Joints? • Where are my Links? • Demo • Looks ahead motion planning
Entities • Points • Orientation • Frame
Example We need coordinate Described by a vector P • Where is the end effecter? EE here P link joint link
Position Vector • P = What is the meaning of the value of a and b? Distance? From what?
The Origin We write P as Means that the value of x is related to the frame O • With respect to the origin yo P link link O xo
The Origin • With respect to the origin yo P a O b xo
Relative Description • The vector is related (referenced) to the specific frame • For now, let us assume that we know where the reference point is
Concrete Example • Object is a set of points, w.r.t. to some fixed point on the object
Another Example • Where is the end effecter? • Position is not enough • We need orientation link link X link link
Orientation • Rotation • Can we just simply use the angle?
Orientation by axes • Attach axes • Axis is a unit vector yE xE link link
Axes also described relatively yE d xE b a c
Angle <-> Axes equivalence • b = sin(θ) • a = cos(θ) • d = sin(θ+90o)=cos(θ) • c = cos(θ+90o)=-sin(θ) yE d xE b a c θ
Angle <-> Axes equivalence • We will soon knows that • Angle axes is simple • Axes angle is simple
Rotation Matrix • We write the orientation as a matrix • Rotation matrix is a matrix of column vectors that describe the axes
Recall the Dot Product A B |C| = A∙B/|B| C
Rotation Matrix • We write the orientation as a matrix yE d xE b a c
Frame Description • End Effecter can be described by Frame • Position and orientation Frame • Let us call the “End Effecter Frame” as “Frame E” ( {E} ) • Describe the other frame related to the origin
Origin as a frame • Origin itself, is also a frame • x = (1,0)T • y = (0,1)T • P = (0,0)T • Hence, the description actually describe a frame relative to another frame
Extend to 3D : Frame Frame B is described by
Mapping from Frame to Frame • If we know P relative to {B} and the frame {B} • What is P relative to {A}?
Rotational Mapping See how B cancelled out
A note on rotational matrix • As we have seen • What is RT ? • Hence, RT=R-1 Transpose is equal to the inverse
Mapping Example 5 10
Mapping Example given 7 3
Mapping Example given
Homogeneous Transform • Mapping using Matrix Multiplication • Instead of • We write Transformation matrix
Homogeneous Transform T Row of 0 and 1
Homogeneous Transform as a Frame Descriptor • Descriptor = (PBORG, RB) • Transform can also be regarded as a descriptor of a frame • is a description of frame {B} w.r.t to {A}
Operator on Points • T is an operator that performs “mapping” from one frame to another frame • Using matrix multiplication • There are also many other operators • Also matrix multiplication
Translational Operator • Translate point P1 by Q • What is P2 ?