1. 项目概述为什么我们要从零造轮子聊到游戏开发尤其是C这块物理引擎往往是新手最怵、老手又爱又恨的部分。市面上有成熟的PhysX、Bullet、Havok功能强大文档齐全为什么还要自己动手从零实现一个轻量级的物理引擎特别是碰撞检测与响应系统这听起来像是费力不讨好的“造轮子”行为。但恰恰是这个过程价值远超你的想象。对于一名C开发者或游戏程序员而言物理引擎不是一个黑盒魔法而是一系列精妙数学和工程决策的集合。直接使用现成引擎你只知道“调用这个API物体会碰撞反弹”但你不知道碰撞检测的边界是如何高效计算的不知道穿透发生时响应力是如何分配的更不知道在性能瓶颈出现时该如何优化。当你的游戏需要一些非标准的物理行为比如一个具有弹性的、可形变的软体或者一个特定风格的平台跳跃手感面对庞大引擎的复杂接口和隐藏的实现你往往会感到束手无策。自己动手实现哪怕只是一个轻量级的原型其意义在于“掌控力”。你能清晰地看到从物体的位置、速度、形状数据到最终屏幕上逼真互动的完整数据流和决策链。你会深刻理解分离轴定理SAT在处理凸包碰撞时的优雅与局限会亲手实现GJK算法那种在迭代中逼近最近点的巧妙会为设计一个既能处理高速运动穿透又保持稳定的连续碰撞检测CCD而绞尽脑汁。这些知识是阅读十篇教程也无法替代的肌肉记忆。这个项目就是一次深度的“外科手术式”学习。我们聚焦于物理引擎最核心、也最富挑战性的两部分碰撞检测与碰撞响应。我们将使用纯C不依赖任何图形库渲染部分仅作简单可视化演示从最基本的向量、矩阵数学库开始搭建逐步构建出能够处理多种基本几何体球体、AABB、OBB、凸多边形的碰撞检测系统并实现包括冲量法和位置修正在内的碰撞响应。最终你将获得一个可运行、可扩展的代码框架更重要的是获得一套解决此类复杂系统问题的思维模型。2. 核心架构与设计思路拆解一个物理引擎即使是轻量级的其内部也是一个精密的“状态机”。它的核心任务是在每一个时间步长Δt内更新场景中所有物理物体的状态。这个过程可以分解为几个清晰的阶段我们的设计也将围绕此展开。2.1 物理循环一帧内的生死时速物理模拟的核心是一个循环通常与游戏的主循环锁步或异步运行。每一帧引擎按顺序执行以下任务力与扭矩的集成Integration收集并清空上一帧累积到每个刚体上的力和扭矩如重力、推力、阻力。速度与位置的更新根据牛顿第二定律Fma和转动定律计算出线加速度和角加速度进而积分更新每个刚体的线速度和角速度最后更新位置和朝向。碰撞检测Broad Phase Narrow Phase这是性能关键。首先进行粗略检测Broad Phase利用空间数据结构如BVH、四叉树、网格快速筛选出可能发生碰撞的物体对避免所有物体两两检测的O(n²)复杂度。然后对筛选出的物体对进行精确检测Narrow Phase使用几何算法如SAT、GJK判断是否真正相交并计算出详细的碰撞信息接触点、穿透深度、碰撞法线。碰撞响应Resolution根据精确检测产生的碰撞信息计算并施加冲量或直接修正位置以模拟碰撞后的反弹、滑动等效果同时处理静摩擦和动摩擦。约束求解Constraint Solver可选但重要处理更复杂的连接关系如关节、绳子、滑轮等。对于轻量级引擎我们可能先实现简单的冲量法响应但需要为约束求解预留接口。我们的轻量级引擎将严格遵循这个流水线。在设计初期我们就需要定义好核心的数据结构比如RigidBody刚体、CollisionShape碰撞形状、Manifold碰撞信息集并确保数据在各阶段间高效、清晰地流动。2.2 形状与刚体数据的基石一切始于数据的定义。我们需要一个Vec2或Vec3本文以2D为例原理相通类来处理向量运算一个Mat2来处理2D旋转。这是我们的数学基础。接下来是CollisionShape基类。它不负责渲染只定义几何边界。我们将派生出CircleShape存储半径。BoxShapeAABB存储半宽高。PolygonShape存储一个顶点列表局部坐标并要求它是凸多边形。这是实现SAT和GJK的基础。然后是RigidBody类它是物理模拟的单元。其核心属性包括position,orientation位置和朝向可以用角度或四元数/矩阵表示。linearVelocity,angularVelocity线速度和角速度。mass,inverseMass质量和其倒数静态物体可设质量为0用倒数处理更安全。inertia,inverseInertia转动惯量及其倒数。force,torque累积的力和扭矩。一个指向CollisionShape的指针描述其几何形状。注意这里有一个关键设计决策我们使用inverseMass和inverseInertia。原因有二一是计算冲量时公式中大量出现质量的倒数直接存储可避免重复除法二是可以优雅地表示静态物体质量无穷大倒数为0在计算中自动忽略其运动。2.3 碰撞管线从粗略到精确碰撞检测是性能瓶颈必须分层优化。Broad Phase粗略阶段 目标快速剔除明显不可能碰撞的物体对。 方案对于轻量级引擎一个简单高效的起点是动态AABB树Dynamic Bounding Volume Hierarchy。我们为每个刚体的形状计算一个轴对齐包围盒AABB并随着物体运动动态更新这个AABB在树中的位置。每一帧遍历树结构收集所有AABB相交的物体对。虽然实现一个完整的动态BVH略有复杂度但其收益巨大是处理数百个物体场景的必备品。作为更简单的替代在物体较少100时可以使用空间哈希网格Spatial Hash Grid将空间划分为网格每个物体根据其AABB放入所属的格子只检测同一格或相邻格内的物体对。Narrow Phase精确阶段 目标对Broad Phase筛选出的物体对进行精确的几何相交测试并生成详细的碰撞信息Manifold。 方案根据形状类型组合分派到不同的检测函数。例如Circle vs Circle简单计算圆心距与半径和。Circle vs Polygon将圆投影到多边形每条边的法线上或寻找多边形上离圆心最近的点。Polygon vs Polygon这是重头戏我们将主要实现分离轴定理SAT。其原理是如果两个凸多边形不相交那么必然存在一条直线轴能将它们完全分离开来。我们只需要在多边形所有边的法线方向上进行投影并检测投影区间是否重叠。SAT能直接给出穿透深度和最小分离轴即碰撞法线非常适合冲量法计算。对于更复杂或3D情况GJKGilbert–Johnson–Keerthi算法配合EPAExpanding Polytope Algorithm是更通用的解决方案。GJK通过迭代计算两个凸体在闵可夫斯基差下的最近点判断是否相交EPA则在相交时基于GJK的单纯形扩展出穿透深度和方向。我们可以在后续进阶中实现GJK/EPA。Manifold结构体需要包含碰撞法线从A指向B、穿透深度、以及一个或多个接触点。在2D中多边形碰撞通常会产生1-2个接触点边-边接触或点-边接触正确处理多个接触点对稳定性至关重要。3. 核心算法深度解析碰撞检测的“心脏”让我们深入到碰撞检测最核心的算法细节理解其原理与实现中的“坑”。3.1 分离轴定理SAT的实现与陷阱SAT是处理凸多边形碰撞直观且高效的算法。其步骤清晰获取两个多边形所有边的法线。注意法线需要是单位向量并且指向多边形的“外侧”根据顶点绕序比如逆时针排列则法线为(-edge.y, edge.x)归一化。对于每条法线作为潜在的分离轴将两个多边形的所有顶点投影到该轴上。找出每个多边形投影后的最小值和最大值形成两个区间[minA, maxA]和[minB, maxB]。判断两个区间是否重叠。如果不重叠则找到了分离轴物体未碰撞立即返回。如果重叠记录下重叠的长度overlap min(maxA, maxB) - max(minA, minB)。遍历所有轴后如果没有找到分离轴则物体碰撞。此时拥有最小重叠长度的那条轴就是“最小分离轴”其方向就是碰撞法线的方向需要仔细判断方向确保是从A指向B。这个最小重叠长度就是穿透深度。听起来很简单但实现时陷阱不少轴的数量对于两个多边形需要检测的轴是两者所有边的法线之和。确保没有遗漏。投影计算顶点V在轴N上的投影标量是点积dot(V, N)。这是整个算法中最频繁的操作确保你的向量点积函数是内联的或者高度优化的。法线方向碰撞法线的方向必须是从物体A指向物体B。在SAT中当你找到最小重叠轴后需要检查这个轴的方向是否是从A的投影区间指向B的投影区间。一个常见的技巧是计算从A的中心指向B的中心的向量然后与候选法线点积。如果点积为正说明法线方向大致是从A指向B可以保留如果为负则将法线取反。浮点数误差在判断区间是否分离时不要使用if (maxA minB || maxB minA)而应该引入一个小的容差值如1e-6即if (maxA minB - epsilon || maxB minA - epsilon)以避免因浮点精度导致的“颤动”碰撞。// SAT 检测的伪代码核心 bool SATDetection(const Polygon polyA, const Polygon polyB, Manifold manifold) { float minOverlap FLT_MAX; Vec2 smallestAxis; // 检查A的边 for (int i 0; i polyA.vertexCount; i) { Vec2 edge polyA.GetEdge(i); Vec2 axis Vec2(-edge.y, edge.x).Normalized(); // 获取法线 float overlap TestAxis(polyA, polyB, axis); if (overlap 0) return false; // 找到分离轴 if (overlap minOverlap) { minOverlap overlap; smallestAxis axis; } } // 检查B的边类似 // ... // 确定法线方向从A指向B Vec2 centerA polyA.GetCenter(); Vec2 centerB polyB.GetCenter(); Vec2 ab centerB - centerA; if (ab.Dot(smallestAxis) 0) { smallestAxis -smallestAxis; } manifold.normal smallestAxis; manifold.penetration minOverlap; // 还需要调用FindContactPoints来找出接触点 FindContactPoints(polyA, polyB, manifold); return true; }3.2 接触点生成稳定性的关键SAT告诉我们碰撞了但冲量需要作用在具体的接触点上。对于多边形碰撞区域可能是一条边两个点接触或一个点点接触。生成准确且稳定的接触点集是避免物体抖动或旋转异常的关键。寻找接触点的算法通常涉及“裁剪”概念。以多边形A碰撞多边形B为例我们需要找到B的哪些顶点嵌入了A内部入射顶点以及A的哪些边与这些顶点接触参考边。一个经典方法是** Sutherland-Hodgman 多边形裁剪算法**的变体或者使用以下步骤确定参考多边形和入射多边形。通常将最小穿透轴所属的多边形作为参考多边形另一个作为入射多边形。在参考多边形上找到与碰撞法线方向最平行的边即参考边。在入射多边形上找到穿透最深的顶点相对于参考边即入射顶点。将入射多边形的顶点投影到参考边的延长线上并裁剪到参考边的两个端点范围内。这些投影点通常1-2个就是接触点。这个过程需要仔细处理各种边界情况比如两个多边形刚好边对边平行碰撞可能会产生两个接触点。在2D中我们最多支持两个接触点这足以保证大多数情况下的物理稳定性。在冲量计算时需要对每个接触点分别计算并分配冲量或者使用平均值。实操心得接触点生成是BUG高发区。一个有效的调试方法是在渲染时用醒目的颜色比如红色画出你计算出的接触点并画出碰撞法线。观察在物体滑动、旋转碰撞时接触点的位置和数量是否合理、稳定。不稳定的接触点会导致物体在碰撞边缘“抖动”或“粘滞”。3.3 冲量法碰撞响应让物体“弹”起来检测到碰撞后我们需要让物体做出反应。最物理正确的方法是冲量法Impulse Method。冲量J是力在时间上的积分它可以瞬间改变物体的动量。我们的目标是计算一个沿着碰撞法线方向的冲量使得在碰撞点两个物体的相对速度在法线方向的分量满足恢复系数Coefficient of Restitution, e的要求即反弹并满足摩擦定律。计算冲量是一个推导过程基于动量守恒和碰撞定律。对于两个刚体A和B在接触点p碰撞前的相对速度v_rel为v_rel (vA ωA × rA) - (vB ωB × rB)其中rA和rB是从物体质心到接触点的向量。我们希望碰撞后相对速度在法线方向n上的分量反向并衰减e倍v_rel_n -e * v_rel_n。通过推导涉及动量和角动量的变化可以得到法线方向的冲量标量j的计算公式j -(1 e) * v_rel_n ------------------------------------------------ (1/mA 1/mB) n · ( (I_A^-1 × (rA × n)) × rA (I_B^-1 × (rB × n)) × rB )这个公式看起来很复杂但分解开来很好理解分子是期望的速度变化分母是一个等效的“阻抗”包含了质量倒数和转动惯量带来的影响。r × n是叉积。计算出法线冲量jn j * n后我们还需要计算切向冲量摩擦力。首先计算切向方向t v_rel_t.normalized()v_rel_t是相对速度减去法线分量。最大静摩擦力大小为μ * |jn|其中μ是摩擦系数。切向冲量jt的大小应使相对切向速度变为零理想情况下但不能超过最大静摩擦力。因此jt clamp(-v_rel_t / (分母项), -μ*|j|, μ*|j|) * t。最后将冲量应用到两个物体上vA (jn jt) / mA ωA I_A^-1 * (rA × (jn jt)) vB - (jn jt) / mB ωB - I_B^-1 * (rB × (jn jt))注意事项这个计算过程假设碰撞是瞬间完成的。在迭代求解多个接触点时简单的顺序处理可能会导致能量溢出或不稳定。工业级引擎会使用如序列冲量法Sequential Impulse或约束求解器如PGS, LCP在一次物理步长内迭代求解所有接触约束以获得更稳定的堆叠和静止接触效果。我们的轻量级引擎可以先实现简单的每对接触独立计算这对于非堆叠的简单碰撞已经足够但需要意识到其局限性。4. 从零到一的实现步骤与核心代码剖析理论说再多不如一行代码。让我们开始搭建这个引擎的骨架。我将以关键模块为例展示核心实现。4.1 基础数学库一切的开端我们首先需要向量和矩阵类。它们必须高效大量使用内联。// Vec2.h class Vec2 { public: float x, y; Vec2() : x(0), y(0) {} Vec2(float x, float y) : x(x), y(y) {} // 基本运算 Vec2 operator(const Vec2 other) const { return Vec2(x other.x, y other.y); } Vec2 operator-(const Vec2 other) const { return Vec2(x - other.x, y - other.y); } Vec2 operator*(float scalar) const { return Vec2(x * scalar, y * scalar); } // 点积、叉积2D叉积返回标量 float Dot(const Vec2 other) const { return x * other.x y * other.y; } float Cross(const Vec2 other) const { return x * other.y - y * other.x; } // 长度、归一化 float LengthSquared() const { return x*x y*y; } float Length() const { return std::sqrt(LengthSquared()); } Vec2 Normalized() const { float len Length(); return len 0 ? (*this) * (1.0f / len) : Vec2(0,0); } // 旋转逆时针 Vec2 Rotated(float angle) const { float c cos(angle), s sin(angle); return Vec2(x * c - y * s, x * s y * c); } };4.2 刚体与形状类数据的容器// RigidBody.h class RigidBody { public: Vec2 position; float rotation; // 弧度 Vec2 linearVelocity; float angularVelocity; Vec2 force; float torque; float mass, invMass; float inertia, invInertia; // 绕质心的转动惯量 float restitution; // 恢复系数 float friction; // 摩擦系数 CollisionShape* shape; void ApplyForce(const Vec2 f) { force f; } void ApplyForceAtPoint(const Vec2 f, const Vec2 point) { force f; torque (point - position).Cross(f); // 2D叉积 } void ClearForces() { force Vec2(0,0); torque 0.0f; } void Integrate(float dt) { if (invMass 0.0f) return; // 静态物体 // 线性积分 Vec2 acceleration force * invMass; linearVelocity acceleration * dt; position linearVelocity * dt; // 角积分 float angularAcc torque * invInertia; angularVelocity angularAcc * dt; rotation angularVelocity * dt; ClearForces(); } };// CollisionShape.h class CollisionShape { public: enum Type { CIRCLE, BOX, POLYGON }; Type type; virtual ~CollisionShape() {} // 获取该形状的轴对齐包围盒AABB用于Broad Phase virtual void ComputeAABB(const RigidBody* body, AABB outAABB) const 0; }; class PolygonShape : public CollisionShape { public: std::vectorVec2 vertices; // 局部坐标 std::vectorVec2 normals; // 每条边的法线单位向量 PolygonShape() { type POLYGON; } void Set(const Vec2* verts, int count) { vertices.assign(verts, verts count); // 计算法线假设顶点逆时针排列 normals.clear(); for (size_t i 0; i vertices.size(); i) { Vec2 edge vertices[(i1)%vertices.size()] - vertices[i]; normals.push_back(Vec2(-edge.y, edge.x).Normalized()); } } // 将局部顶点变换到世界空间 Vec2 GetWorldVertex(int index, const RigidBody* body) const { Vec2 v vertices[index]; return v.Rotated(body-rotation) body-position; } };4.3 碰撞检测与响应的整合在物理世界类PhysicsWorld中我们维护一个刚体列表并在每帧调用Step函数。void PhysicsWorld::Step(float dt) { // 1. 积分 for (auto body : bodies) { body-Integrate(dt); } // 2. 碰撞检测Broad Phase 略假设我们得到了一个潜在碰撞对列表 contacts std::vectorContact contacts; BroadPhase(contacts); // 3. 精确检测并生成流形 for (auto contact : contacts) { if (NarrowPhase(contact.bodyA, contact.bodyB, contact.manifold)) { // 4. 碰撞响应冲量法 ResolveCollision(contact.manifold); // 可选位置修正解决穿透 PositionalCorrection(contact.manifold); } } }ResolveCollision函数就是实现前面冲量公式的地方。PositionalCorrection是一个简单的技巧用于解决因离散时间步长导致的微小穿透它直接沿着碰撞法线方向将两个物体推开一小段距离通常按穿透深度的一定比例这能有效防止物体“粘”在一起。void ResolveCollision(Manifold m) { RigidBody* A m.bodyA; RigidBody* B m.bodyB; Vec2 normal m.normal; // 计算每个接触点的相对位置向量 std::vectorVec2 rA_list, rB_list; for (auto cp : m.contactPoints) { rA_list.push_back(cp - A-position); rB_list.push_back(cp - B-position); } // 简单处理使用第一个接触点或计算平均冲量多接触点更复杂 Vec2 rA rA_list[0]; Vec2 rB rB_list[0]; // 计算相对速度 Vec2 vA A-linearVelocity Vec2(-A-angularVelocity * rA.y, A-angularVelocity * rA.x); Vec2 vB B-linearVelocity Vec2(-B-angularVelocity * rB.y, B-angularVelocity * rB.x); Vec2 vRel vA - vB; float vRelNormal vRel.Dot(normal); // 如果相对速度在分离或者非常小跳过已经分离或静止接触 if (vRelNormal 0) return; // 计算恢复系数使用最小值 float e std::min(A-restitution, B-restitution); // 计算分母项 float rA_cross_n rA.Cross(normal); float rB_cross_n rB.Cross(normal); float denom A-invMass B-invMass rA_cross_n * rA_cross_n * A-invInertia rB_cross_n * rB_cross_n * B-invInertia; // 计算法线冲量标量 float j -(1 e) * vRelNormal; j / denom; j / (float)m.contactPoints.size(); // 粗略处理多接触点平均分配 Vec2 impulse normal * j; // 应用冲量 A-linearVelocity impulse * A-invMass; A-angularVelocity rA.Cross(impulse) * A-invInertia; B-linearVelocity - impulse * B-invMass; B-angularVelocity - rB.Cross(impulse) * B-invInertia; // 摩擦力计算略需计算切向方向冲量并应用 }5. 常见问题、调试技巧与性能优化自己动手实现物理引擎几乎一定会遇到各种诡异的问题。下面是一些典型问题及其排查思路。5.1 物体穿透或抖动这是最常见的问题。原因1时间步长dt太大。物理模拟是离散的如果dt太大物体一帧移动的距离可能远超其本身尺寸导致“隧道效应”直接穿过另一个物体。解决减小dt或者实现连续碰撞检测CCD。CCD的基本思想是检查物体从上一帧到当前帧的运动扫掠体是否与其他物体相交这能有效防止高速子弹穿过薄墙。原因2碰撞响应冲量计算错误。检查法线方向是否正确从A指向B检查恢复系数e是否在[0,1]范围内检查分母项计算特别是转动惯量相关部分是否正确。使用调试绘图画出每一帧的碰撞法线和冲量施加方向。原因3浮点数精度误差累积。微小的穿透可能因为精度问题无法被有效修正。解决引入一个小的“容差slop”比如0.01个单位。在位置修正时只修正穿透深度大于容差的部分。在判断分离时也使用容差。原因4多接触点处理不当。当一个物体如盒子与地面有多个接触点时如果每个接触点独立计算冲量可能会产生过大的纠正力导致物体上下抖动。解决需要实现一个简单的接触点缓存和冲量累积机制或者使用迭代求解器在一次步长内统一处理所有接触约束。5.2 旋转行为异常物体碰撞后旋转速度过快、过慢或方向不对。检查转动惯量Inertia的计算。对于多边形转动惯量公式为I (1/12) * mass * (width² height²)矩形绕质心。确保你为不同形状正确计算了inertia和invInertia。检查冲量作用点rA和rB。它们必须是从物体质心指向接触点的向量。如果错误地使用了从质心指向形状中心的向量旋转效果会完全错误。检查叉积计算。在2D中向量a和b的叉积是一个标量a.x*b.y - a.y*b.x。在计算扭矩r × impulse时确保叉积顺序正确。扭矩标量 r.x * impulse.y - r.y * impulse.x。5.3 性能瓶颈排查当物体数量增多时帧率下降。首先定位瓶颈使用简单的时间测量工具如std::chrono分别记录Broad Phase、Narrow Phase和碰撞响应所花费的时间。Broad Phase优化如果Broad Phase耗时占比高说明你的空间划分算法需要优化。确保动态AABB树的更新插入、删除、重构是高效的。或者考虑切换到更简单的空间哈希网格它对大量均匀分布的小物体效果很好。Narrow Phase优化确保SAT或GJK算法中最内层循环如投影计算、点积是高度优化的。避免在循环中创建临时向量对象尽量使用基本类型操作。对于圆形等简单形状使用特化的检测函数避免走通用的多边形检测流程。缓存友好性尽量让数据如顶点、法线在内存中连续存储提高CPU缓存命中率。避免在每帧碰撞检测中频繁进行动态内存分配如std::vector的push_back可以预先分配好内存池。5.4 调试可视化你的眼睛一个强大的调试渲染系统是无价的。至少要实现以下功能绘制每个刚体的轮廓。绘制每个刚体的AABB用于Broad Phase调试。用不同颜色高亮正在发生碰撞的物体。在碰撞点画一个十字或圆点并画出一条线表示碰撞法线的方向和大小。画出每个刚体的质心和速度向量。通过观察这些可视化信息你可以直观地看到算法是否按预期工作。例如如果碰撞法线方向总是很奇怪那肯定是SAT中法线方向判断逻辑出错了如果接触点在空中乱跳那说明接触点生成算法不稳定。实现这个轻量级物理引擎的过程就像在搭建一个精密的机械钟表。每一个齿轮算法都必须严丝合缝任何一点偏差都会导致整个系统运行失常。但当你看到自己编写的代码让一堆几何体在屏幕上遵循牛顿定律运动、碰撞、反弹、滚动时那种成就感是无与伦比的。这不仅仅是实现了一个功能更是对计算机如何模拟物理世界的一次深刻理解。从这里出发你可以继续扩展加入关节、软体、甚至流体模拟逐步构建起属于自己的、完全可控的物理世界。