模拟速度稳定吊舱算法时写的,为离散模型。简单的PID控制速度稳定