Smoothed trajectory for non-moving points has extremely long duration

[ehuang3]

Given an input trajectory which is a pair of two of the same points, the duration of the smoothed trajectory is around 40s.

[tobiaskunz]

Paths with two consecutive identical waypoints are currently not supported.

I propose changing your code such that it does not try to generate non-moving, zero-second trajectories.