Autofocus in Two-Wavelength Contouring for Fast Inspection of Micro Parts