Pack objects by objects' distance in Grasshopper. (C#)

packobjectsbydistance.cs

private void RunScript(List<Point3d> pts, List<object> objs, double thresh, ref object A, ref object B)
  {
    DataTree<object> tree = new DataTree<object>();
    List<int> usedList = new List<int>();
    List<Point3d> centers = new List<Point3d>();
    for(int i = 0; i < pts.Count; i++){
      var pt1 = pts[i];
      if(!usedList.Contains(i)){
        GH_Path path = new GH_Path(i);
        tree.Add(objs[i], path);
        centers.Add(pts[i]);
        for(int n = 0; n < pts.Count; n++){
          if(i != n){
            if(!usedList.Contains(n)){
              var pt2 = pts[n];
              double dist = pt1.DistanceTo(pt2);
              if(dist < thresh){
                tree.Add(objs[n], path);
                usedList.Add(n);
              }
            }
          }
        }
        usedList.Add(i);
      }
    }

    A = tree;
    B = centers;
  }