Implementation of SplinePath and its optimization.Code Clean. TODO: fix infinite time optimizing with collision avoidance