Distance calculation using the homography matrix improved. Nullpointer
exception handling in regard to self localisation fixed.