Added visualization

-Commented out saving of transformation to file, so it runs faster
-Changed hard coded parameters so it runs rather fast, but unaccurate
for now, because the visualisation takes all the cpu time (have to run
it in a seperate thread and with higher priority i guess)
-added visualization