Adding little test
Moving all code to root directory until I learn how to use g++ correctly
Some corrections