Fixed: issue where distance being added to an unkown point in normalizeTrajectory was incorrect