AABB向中心点移动的碰撞响应问题：自定义物理引擎效果不符求助

问题背景 #

需要实现一组矩形向同一个中心点移动，移动过程中避免互相重叠，最终紧凑排列在中心点附近。现有自定义碰撞引擎运行效果与预期不符。

现有代码核心缺陷 #

• 全局IsColliding变量逻辑完全错误：并行循环下存在线程安全问题，且任意一对未碰撞的矩形都会将该变量重置为false，导致移动逻辑异常中断
• 碰撞处理逻辑错误：检测到碰撞后直接清零对应方向的移动向量，会导致矩形直接卡死，无法继续向中心点移动排列
• 移动逻辑限制单轴移动：仅允许X或Y单轴向中心点移动，无法实现斜向位移，最终无法形成紧凑的聚集排列效果
• 多线程竞态问题：并行循环中无锁写入MovementVectors数组，多个线程同时修改同一个数组元素会导致数值异常，运行结果不可预测
• 碰撞检测时机滞后：仅检测当前位置的重叠状态，没有预判移动后的位置是否会重叠，检测到碰撞时已经发生了重叠
• 碰撞对重复检测：双层全量遍历矩形列表，每对矩形会被重复检测两次，既浪费性能又会导致移动向量被重复修改

修复方案 #

1. 移除全局IsColliding变量，取消对移动逻辑的错误限制
2. 碰撞检测改为预判逻辑：先计算矩形应用当前移动向量后的位置，再检测移动后是否重叠，提前处理碰撞
3. 碰撞处理改为最小分离向量方案：检测到碰撞后计算两个矩形的最小分离距离，两个矩形各承担一半的分离位移，仅抵消重叠部分的移动量，不会完全停止向中心点的移动
4. 移动逻辑改为直接生成朝向中心点的单位向量，允许斜向移动
5. 取消碰撞处理的并行循环，或添加线程锁保证数组写入安全
6. 优化碰撞遍历逻辑：外层循环i从0到矩形总数减1，内层循环j从i+1到矩形总数减1，每对矩形仅检测一次
7. 增加临近吸附逻辑：当矩形距离中心点小于阈值、且和相邻矩形间隙小于阈值时，触发吸附对齐，实现无间隙的紧凑排列效果

核心代码修改示例 #

// 修改后的移动逻辑
public void MoveRectangles()
{
    for(int i = 0; i < Spaces.Count; i++)
    {
        if(Spaces[i].Center.DistanceTo(Center) <= 1) continue;
        // 直接生成朝向中心点的移动向量
        Vector3d translationVector = Center - Spaces[i].Center;
        translationVector.Unitize();
        MovementVectors[i] = translationVector * MoveDistance;
    }
}

// 修改后的碰撞处理逻辑
public void CollideRectangles()
{
    // 取消并行循环避免竞态问题
    for(int i = 0; i < Spaces.Count; i++)
    {
        // 预判i的移动后位置
        Rectangle3d movedRectI = Spaces[i];
        movedRectI.Transform(Transform.Translation(MovementVectors[i]));
        var rectIMinX = movedRectI.Corner(0).X;
        var rectIMaxX = movedRectI.Corner(2).X;
        var rectIMinY = movedRectI.Corner(0).Y;
        var rectIMaxY = movedRectI.Corner(2).Y;
        
        for(int j = i + 1; j < Spaces.Count; j++)
        {
            // 预判j的移动后位置
            Rectangle3d movedRectJ = Spaces[j];
            movedRectJ.Transform(Transform.Translation(MovementVectors[j]));
            var rectJMinX = movedRectJ.Corner(0).X;
            var rectJMaxX = movedRectJ.Corner(2).X;
            var rectJMinY = movedRectJ.Corner(0).Y;
            var rectJMaxY = movedRectJ.Corner(2).Y;
            
            // 检测移动后是否重叠
            bool overlapX = rectIMinX < rectJMaxX && rectIMaxX > rectJMinX;
            bool overlapY = rectIMinY < rectJMaxY && rectIMaxY > rectJMinY;
            if (overlapX && overlapY)
            {
                // 计算X方向最小分离距离
                double overlapXVal = Math.Min(rectIMaxX, rectJMaxX) - Math.Max(rectIMinX, rectJMinX);
                double sepX = movedRectI.Center.X < movedRectJ.Center.X ? -overlapXVal / 2 : overlapXVal / 2;
                // 计算Y方向最小分离距离
                double overlapYVal = Math.Min(rectIMaxY, rectJMaxY) - Math.Max(rectIMinY, rectJMinY);
                double sepY = movedRectI.Center.Y < movedRectJ.Center.Y ? -overlapYVal / 2 : overlapYVal / 2;
                // 应用分离位移到移动向量
                MovementVectors[i] += new Vector3d(sepX, sepY, 0);
                MovementVectors[j] -= new Vector3d(sepX, sepY, 0);
            }
        }
    }
}

内容的提问来源于stack exchange，提问作者Youssef