added documentation regarding forward kinematic matrix math