Einsum notation for chained prismatic and revolute joints. Added also a basic urdf as example.

@jauhri Can you run your tests to see if nothing broke?