using temporal filtering and a cost function to track lanes, fix cost function so there is no jump