Example program added and Algorithms working

Now you can choose to compile the example test program of the library.
The Algorithms are now usable.