Aligning algorithm with roads