This article describes forward kinematics of the six degrees of freedom manipulator and its geometric inverse kinematics geometric.
The algorithm described in this article has not been strictly tested. Take your own risk while using it
You are NOT ALLOWED to copy this article
The robot structure is shown in the figure below: