Sort Data before it goes into the backend.

[redto0]

Basicall just add a function to the PolynomialPlannerAi::polynomial_cb and put it before the

std::optional<nav_msgs::msg::Path> path_optional =
backend::create_path(cv_points_left, cv_points_right, camera_rgb, frame_id);

to sort the contours before we get them. You can write your own sorting algorithm or borrow one from else where. Make sure its good to use and you credit them in there headers