Kossel: forward kinematics implementation. Added Vector3 class to handle vector math, eg bed autolevel transform