HQY 规划控制算法