spline_traj_printer and dependencies
Plots the spline trajectory using the displayPath topic