slide1 n.
Skip this Video
Loading SlideShow in 5 Seconds..
Inverse Kinematics PowerPoint Presentation
Download Presentation
Inverse Kinematics

Loading in 2 Seconds...

play fullscreen
1 / 66

Inverse Kinematics - PowerPoint PPT Presentation

  • Uploaded on

Inverse Kinematics. Set goal configuration of end effector calculate interior joint angles. Analytic approach – when linkage is simple enough, directly calculate joint angles in configuration that satisfies goal. Numeric approach – complex linkages

I am the owner, or an agent authorized to act on behalf of the owner, of the copyrighted work described.
Download Presentation

Inverse Kinematics

An Image/Link below is provided (as is) to download presentation

Download Policy: Content on the Website is provided to you AS IS for your information and personal use and may not be sold / licensed / shared on other websites without getting consent from its author.While downloading, if for some reason you are not able to download a presentation, the publisher may have deleted the file from their server.

- - - - - - - - - - - - - - - - - - - - - - - - - - E N D - - - - - - - - - - - - - - - - - - - - - - - - - -
    Presentation Transcript
    1. Inverse Kinematics Set goal configuration of end effector calculate interior joint angles Analytic approach – when linkage is simple enough, directly calculate joint angles in configuration that satisfies goal Numeric approach – complex linkages At each time slice, determine joint movements that take you in direction of goal position (and orientation)

    2. Forward Kinematics - review Articulated linkage – hierarchy of joint-link pairs Pose – linkage is a specific configuration Pose Vector – vector of joint angles for linkage Degrees of Freedom (DoF) – of joint or of whole figure Types of joints: revolute, prismatic • Tree structure – arcs & nodes • Recursive traversal – concatenate arc matrices • Push current matrix leaving node downward • Pop current matrix traversing back up to node

    3. Inverse Kinematics End Effector L1 q3 q2 L3 L2 q1 Goal

    4. Inverse Kinematics Underconstrained – if fewer constraints than DoFs Many solutions Overconstrained – too many constraints No solution Reachable workspace – volume the end effector can reach Dextrous workspace – volume end effector can reach in any orientation

    5. Inverse Kinematics - Analytic Given arm configuration (L1, L2, …) Given desired goal position (and orientation) of end effector: [x,y] or [x,y,z, y1,y2, y3] Analytically compute goal configuration (q1,q2) Interpolate pose vector from initial to goal

    6. Analytic Inverse Kinematics q2 L2 Goal L1 (X,Y) q1

    7. Analytic Inverse Kinematics Multiple solutions Goal (X,Y)

    8. Analytic Inverse Kinematics L2 180- q2 L1 (X,Y) q1 qT

    9. Analytic Inverse Kinematics L2 180- q2 L1 (X,Y) q1 Y qT X

    10. Law of Cosines C A a B

    11. Analytic Inverse Kinematics L2 (X,Y) L1 180- q2 q1 qT Y X

    12. Analytic Inverse Kinematics

    13. Iterative Inverse Kinematics When linkage is too complex for analytic methods At each time step, determine changes to joint angles that take the end effector toward goal position and orientation Need to recompute at each time step

    14. Inverse Jacobian Method a2 d2=EF-J2 End Effector a2 x d2 q2 - Compute instantaneous effect of each joint - Linear approximation to curvilinear motion - Find linear combination to take end effector towards goal position

    15. Inverse Jacobian Method Instantaneous linear change in end effector for ith joint = (EF - Ji) x ai

    16. Inverse Jacobian Method What is the change in orientation of end effector induced by joint i that has axis of rotation ai and position Ji? Angular velocity

    17. Inverse Jacobian Method Solution only valid for an instantaneous step Angular affect is really curved, not straight line Once a step is taken, need to recompute solution

    18. Set up equations yi: state variable xi : system parameter fi : relate system parameters to state variable Inverse Jacobian Method - Mathematics

    19. Matrix Form Inverse Jacobian Method - Mathematics

    20. Inverse Jacobian Method - Mathematics Use chain rule to differentiate equations to relate changes in system parameters to changes in state variables

    21. Inverse Jacobian Method - Mathematics Matrix Form

    22. Change in position (and orientation) of end effector Change in joint angles Linear approximation that relates change in joint angle to change in end effector position (and orientation) Inverse Jacobian Method

    23. Inverse Jacobian Method

    24. Inverse Jacobian Method

    25. = (S - J1) x a1 = w1 Inverse Jacobian Method

    26. The Matrices

    27. The Matrices N DoFs V – desired linear and angular velocities 3x1, 6x1 J – Jacobian Matrix of partials 3xN, 6xN N x 1 q – change to joint angles (unknowns)

    28. Pseudo Inverse of the Jacobian

    29. LU decomposition Solving using the Pseudo Inverse

    30. A solution of this form When put into this formula Like this After some manipulation, you can show that it… …doesn’t affect the desired configuration Adding a Control Term But it can be used to bias The solution vector

    31. Desired angles and corresponding gains are input ‘z’ is H differentiated Form of the Control Term Bias to desired angles (not the same as hard joint limits) Where the deviation is large, you bump up the solution vector in such a way that you don’t disturb the desired effect

    32. Include this in equation Isolate vector of unknown Rearrange to isolate the inverse Some Algebraic Manipulation

    33. LU decomp. Solving the Equations

    34. Control Term Use to bias to desired mid-angle Does not enforce joint angles Does not address “human-like” or “natural” motion Only kinematic control – no forces involved

    35. Jacobian Transpose Use projection of effect vector onto desired movement

    36. Jacobian Transpose S

    37. Jacobian Transpose

    38. Alternate Jacobian G Use the goal postion instead of the end-effector!!?? !? …

    39. substitution Solve Damped Least Squares G

    40. Hueristic Human-Like Linkage (HAL) 7 DoF linkage RA (q1,q2 ,q3) , RB ( q4), RC(q5,q6 ,q7) 3 DoF G Decompose into simpler subproblems 1 DoF Set hand position and rotation based on relative position of Goal to shoulder 3 DoF Fix wrist position – use as Goal

    41. L L1 L2 Hueristic Human-Like Linkage (HAL) s Set q4 based on distance between shoulder and wrist w e Assume axis of elbow is perpendicular to plane defined by s, e, w use law of cosines

    42. Hueristic Human-Like Linkage (HAL) s q4 w e Elbow lies on circle defined by w, s & q4 Determine elbow position based on heuristics For example: project forearm straight from hand orientation if arm intersects torso or a shoulder angle exceeds joint limit (or exceeds comfort zone) – Clamp to inside of limits

    43. Hueristic Human-Like Linkage (HAL) s q4 w e From e and s, determine RA From e and w and hand orientation, determine RB

    44. Cyclic-Coordinate Descent .

    45. Cyclic-Coordinate Descent Rotational joint: .

    46. Cyclic-Coordinate Descent Rotational joint: .

    47. Cyclic-Coordinate Descent Rotational joint: .

    48. Cyclic-Coordinate Descent Rotational joint: .