TrajectoryBuffer: take inspiration from m3t_tracker_ros

[MaximilienNaveau]

          I made similar thing, but with sorting of the results based on timestamps. This might come in handy if we decide to stream points instead of buffering them. You can find in the [m3t_tracker_ros](https://gitlab.laas.fr/kwojciecho/m3t_tracker_ros/-/blob/main/m3t_tracker_ros/m3t_tracker_ros/image_time_buffer.py?ref_type=heads)

Originally posted by @Kotochleb in #97 (comment)

[Kotochleb]

To continue on the topic...
TrajectoryBuffer might overwrite functions

def append(self, x: Any) -> None:
    bisect.insort(self.__super__(), x) 

And

def extend(self, x: Any) -> None:
    self.__super__().extend(x)
    self.__super__() = sorted(self.__super__()) 

I am not 100% confident with the suggested implementation, but I would see it like this. Additionally, I am not sure about the efficiency of the lather. Maybe an if statement to avoid resorting every time would be useful.