Ported old lane detector code as it is. Contains mem leak but works as expected. Yet to test on field.