刚性两杆机构的动力学程序，为机器人动力学建模以及控制打下基础，与很多方法不同的是，这里采用龙格库塔法，显著提高运算精度-Rigid body dynamics program two shots for robot dynamics modeling and control of the foundation, with a lot of different methods is used here Runge-Kutta method, significantly improving oper