插补原理,速度控制