Fully functional Set of Code!

Will still be cleaned up a bit (adding more comments, etc..) but it's
working!