Optimize Radial Tree Algorithm