A Lagrangian Half-Quadratic approach to robust estimation and its applications to road scene analysis