Started again with basic tests

Issue with distance computation