First commit on the "Praktikum 3"
Calculation of the distance in working badly. might not work if
dimension is bigger than 2!