# Geometrical solution to an IK problem for a humanoid robot leg

On the attached figure, I show a graphical representation of the problem I am facing. I have developed a humanoid robot with a thigh which makes an angle with respect to the leg. It means that there is always a constant distance (R) – whatever the rotation of the thigh is - between the Pelvic and the leg. Besides, the foot is articulated with a forefoot and a midfoot. If I want to compute the orientation of the leg and thigh with respect to a given position and orientation of the Pelvic (represented by the point $C$) and the Foot (represented by $A$ the position of the ankle and $\vec{U}$ the orientation of the foot.

I come up with the geometrical problem of computing a plane $P$, passing through $C$ with one orientation given by $\vec{U}$, which is tangent to a sphere whose center is the extremity of the Pelvic (point $C$).

Knowing the point of tangency $T$ I can compute the position of the knee $K$ and then the angular values for the leg and the thigh.

But I cannot find the equations to solve it so far... or may be there is another geometrical solution I did not think of?

I am trying to find a geometrical answer before going through a DH description + finding the values via decoupling and so on...("classical" Ik resolution).

• Thanks for putting good details into your question. I am still a little confused by a couple of things, though. First, are you trying to solve the forward or the inverse kinematics problem (or both)? If you are trying to find the position of $A$ and direction of $\vec U$ given angles $K$ and $L$ then you want the forward kinematics equations. Second, is it correct that the axes of $K$ and $L$ are perpendicular to the plane $P$, and the axis of $A$ is in plane $P$ but perpendicular to link $LA$? – SteveO Feb 10 '17 at 13:53
• Ok, I think I understand the first confusion point. Is this true: you want to find joint angles at $T$ and $K$ given $C$, $A$, and $\vec U$? And you know the position of $T$ already. If so, can we start with a base coordinate system with its origin at $T$, with $\vec z$ pointed toward $C$ and $\vec x$ pointed toward $K$? – SteveO Feb 10 '17 at 14:06
• Hi Steve, I know $C$, $T$ and $\vec{u}$. I want to compute $T$ and $K$ and then the joint angles. I know this is not a conventional way to resolve such problem. (the classical approach is described here link. – fabrice Feb 10 '17 at 15:54
• Getting closer. The leg structure sure resembles a PUMA arm, but with different names. That arm has a shoulder offset similar to your value $R$. Are you able to provide a drawing similar to Figure 4 in this paper (scisweb.ulster.ac.uk/~siddique/Robotics/CHAPT4.pdf) so we can be sure to understand the joint arrangements? It's tough to be sure of the kinematics when the orange dots you use to represent axes of rotation don't clearly show the rotational axis, and the side view helps but not completely. Thanks! – SteveO Feb 10 '17 at 18:03