Code restructuring needed

[SteponasK]

Will need to restructure code, make less clutter in main.cpp file, maybe add classes.

[SteponasK]

Add all files in to the src/ folder