Added RadiusOutlierRemoval

+ moved display refresh to a dedicated function
+ minor calling changes