Working on step 2 of map matching.