Merge pull request #1 from gakki99/master

bug fix
reset submodule
forward Kinematics
inverse kinematics
bug fix