Major overhaul of all source files

[aakash1104]

Basically code quality is horrible and I've become a better programmer since then (maybe?). Need to rework everything in this repo. Some TODOs

1. Generic Graph data structure
2. Refactor everything into an object oriented model
3. Rework explanations in README

I'll keep updating this issue if I think of more stuff