Fixed distance calculation error, added new test scenario file