Fix Trajectory timestamp generation

The Trajectory constructor generates timestamps using GenerateTimestamps, if those aren't provided by the caller. However, due to rounding issues, the returned timestamps sometimes lacked one timestamp.

Problem occurred while implementing Implement 'PointAt'-skill (sw/armarx/skills/control!53 - merged)