basic alg + test + verplaatsen tests

werken nog niet.