Refactor Scan mode

Currently: we start at a angle and increase by a max angle difference : code

Scope of this issue:

• Use start and stop angle as definition
• Resort parameters
• Write unittest