Working mapping from joint space to Cartesian space. Increased readibility.