Interpolate between poses (Follow-up from "Visualize LocalTrajectory")

The following discussion from !35 (merged) should be addressed:

• @fabian.reister started a discussion:

  TODO; Interpolate between trajectory points

@groegerto as discusses, you can implement this as a method within the LocalTrajectory class, e.g. evaluate(timestamp)