二连杆动力学建模,matlab程序非simulink实现,动力学建模通过拉格朗日方程实现。