B-Spline Based Filters for Multi-Point Trajectories Planning