二级倒立摆的数学模型推导