以前写的风力摆程序,先进行了物理矫正,然后用位置环PID进行控制