reset submodule
forward Kinematics