不使用bezier库;改进Bizuer,避免在重复输出控制点; 同时将等间隔的Bizuer曲线改进为等间距的Bizuer曲线,避免因为距离过短导致点过于密集;增加速度规划的功能