Solved a bug when computing the footprint collision: One of the variables was...

Solved a bug when computing the footprint collision: One of the variables was cast to an integer and the Infinity value has been changed by the maximum double value.
Solved a bug when the linear speed was 0.0: The trajectory was computed backwards in this case.