Inverse Kinematics for a Robot Manipulator with Six Degrees of Freedom

The inverse kinematics problem for serial manipulators is central in the automatic control of robot manipulators. Given the pose of the end effector, the problem corresponds to computing the joints rotation for that pose. (Pose is the robotics term for the combination of position and orientation.)
This Demonstration shows a forward kinematic model of an industrial manipulator using D-H (Denavit–Hartenberg) notation to propagate links transformations from base to end effector. To solve inverse kinematics problem, this demonstration shows a close-form solution with 8 configures. The end effector’s are free to move for all 6 degrees of freedom and for position, and and for orientation. A simple trajectory generation is introduced to make the robot move from one point to another along a straight line.


  • [Snapshot]
  • [Snapshot]
  • [Snapshot]


[1] M. Raghavan and B. Roth, "Kinematic Analysis of the 6R Manipulator of General Geometry," Proceedings of the Fifth International Symposium on Robotics Research (H. Miura, ed.), Cambridge, MA: MIT Press, 1990 pp. 263–269. dl.acm.org/citation.cfm?id=112715&CFID=542850644&CFTOKEN=11490130.
[2] D. Manocha and J. F. Canny, "Efficient Inverse Kinematics for General 6R Manipulators," IEEE Transactions on Robotics and Automation, 10(5), 1994 pp. 648–657. doi:10.1109/70.326569.
[3] R. N. Jazar, Theory of Applied Robotics (Kinematics Dynamics and Control), 2nd Ed., Springer: New York, 2010, pp. 341–356.
    • Share:

Embed Interactive Demonstration New!

Just copy and paste this snippet of JavaScript code into your website or blog to put the live Demonstration on your site. More details »

Files require Wolfram CDF Player or Mathematica.

Mathematica »
The #1 tool for creating Demonstrations
and anything technical.
Wolfram|Alpha »
Explore anything with the first
computational knowledge engine.
MathWorld »
The web's most extensive
mathematics resource.
Course Assistant Apps »
An app for every course—
right in the palm of your hand.
Wolfram Blog »
Read our views on math,
science, and technology.
Computable Document Format »
The format that makes Demonstrations
(and any information) easy to share and
interact with.
STEM Initiative »
Programs & resources for
educators, schools & students.
Computerbasedmath.org »
Join the initiative for modernizing
math education.
Step-by-Step Solutions »
Walk through homework problems one step at a time, with hints to help along the way.
Wolfram Problem Generator »
Unlimited random practice problems and answers with built-in step-by-step solutions. Practice online or make a printable study sheet.
Wolfram Language »
Knowledge-based programming for everyone.
Powered by Wolfram Mathematica © 2018 Wolfram Demonstrations Project & Contributors  |  Terms of Use  |  Privacy Policy  |  RSS Give us your feedback
Note: To run this Demonstration you need Mathematica 7+ or the free Mathematica Player 7EX
Download or upgrade to Mathematica Player 7EX
I already have Mathematica Player or Mathematica 7+