Update MathHelper.cpp

Added implementation for GetIndexFromRadius.