Added in movement and scanning

Initial version with:
1) Initialization
2) Movement
3) Scanning (1 scan per position)