Radius feature algoritm almost finished