add samples to vision state machine actual function not yet implemented
Merge branches 'version3' and 'fds' into version3