Method and arrangement for fast and robust chromatic confocal 3D measurement technology