Create main

a main to use and test the algorithm