First working version

- Everything compiles and runs
- Added code to test the whole thing on laptop using premade images
- Very simple algo