Refactor road and lane position calculations