Input Shaping Via B-Spline Filters for 3-D Trajectory Planning