Reimplement FrameBase::getPreviousFrame() and getNextFrame()

Now that the Trajectory has a std::map of timestamps and frames, these functions in FrameBase should be reimplemented. Currently the whole map (it was a list before) is iterated reversely. Could be easily reimplemented using find(shared_from_this()).