1) Add a global way to set Radius 2) Change all double[3] to Point3d