Impoved performance

- Slightly other algorythm

2DO:
- show frames of results for demonstration
- use any video as input