switched over to new, closed-form forward kinematic solution