geometry methods for forward kinematics

w