Matlab + Part of SysML

在MagicDraw中Kinematics部分已经完成建模