New startFocusScan() and startScan() methods.

Fixed bug in SetupThread: now the servo setup is always performed,
even if the servo is already in the target positions. This
semplify the scan, otherwise we have to setup the servo during
the excecution of the scan methods.