履带式推土机 纵前向运动 恒θ控制 物理仿真 铲刀刃 轨迹 纵向找平原理 β型扰动