How find indices of waypoint of path in the result trajectory.

[chibai]

spline_path = toppra.SplineInterpolator(np.linspace(0, 1, len(way_points)), way_points, bc_type="natural")
toppra_instance = toppra.algorithm.TOPPRA(constraint_list=toppra_constraint_list,
                                                path=spline_path,
                                                gridpoints=np.linspace(0, spline_path.duration, 2 * len(way_points) + 1),
                                                solver_wrapper="seidel",
                                                parametrizer="ParametrizeSpline")
jnt_traj = toppra_instance.compute_trajectory()
time_points = np.linspace(0, self.__duration, int(self.__duration // TIME_STEP) + 1)
position_points: np.ndarray = self.__jnt_traj(time_points)

I'd like to find indices of waypoints in the final position_points
There maybe bugs to use mean sqare error if there're exactly same 2 way points