@@ -236,7 +236,7 @@ public void Prestep(Bodies bodies, ref Vector<int> bodyReferences, int count,
236
236
ref var prestepContact = ref Unsafe . Add ( ref prestepContactStart , i ) ;
237
237
ref var projectionContact = ref Unsafe . Add ( ref projectionContactStart , i ) ;
238
238
projectionContact . Normal = prestepContact . Normal ;
239
- Helpers . BuildOrthnormalBasis ( prestepContact . Normal , out var x , out var z ) ;
239
+ Helpers . BuildOrthonormalBasis ( prestepContact . Normal , out var x , out var z ) ;
240
240
TangentFrictionOneBody . Prestep ( ref x , ref z , ref prestepContact . Offset , ref projectionCommon . InertiaA , out projectionContact . Tangent ) ;
241
241
PenetrationLimitOneBody . Prestep ( projectionCommon . InertiaA ,
242
242
prestepContact . Offset , prestepContact . Normal , prestepContact . Depth ,
@@ -257,7 +257,7 @@ public unsafe void WarmStart(ref BodyVelocities wsvA, ref TProjection projection
257
257
{
258
258
ref var contact = ref Unsafe . Add ( ref contactStart , i ) ;
259
259
ref var contactImpulse = ref Unsafe . Add ( ref accumulatedImpulsesStart , i ) ;
260
- Helpers . BuildOrthnormalBasis ( contact . Normal , out var x , out var z ) ;
260
+ Helpers . BuildOrthonormalBasis ( contact . Normal , out var x , out var z ) ;
261
261
TangentFrictionOneBody . WarmStart ( ref x , ref z , ref contact . Tangent , ref common . InertiaA , ref contactImpulse . Tangent , ref wsvA ) ;
262
262
PenetrationLimitOneBody . WarmStart ( contact . Penetration , common . InertiaA , contact . Normal , contactImpulse . Penetration , ref wsvA ) ;
263
263
}
@@ -275,7 +275,7 @@ public void Solve(ref BodyVelocities wsvA, ref TProjection projection, ref TAccu
275
275
{
276
276
ref var contact = ref Unsafe . Add ( ref contactStart , i ) ;
277
277
ref var contactImpulse = ref Unsafe . Add ( ref accumulatedImpulsesStart , i ) ;
278
- Helpers . BuildOrthnormalBasis ( contact . Normal , out var x , out var z ) ;
278
+ Helpers . BuildOrthonormalBasis ( contact . Normal , out var x , out var z ) ;
279
279
var maximumTangentImpulse = common . FrictionCoefficient * contactImpulse . Penetration ;
280
280
TangentFrictionOneBody . Solve ( ref x , ref z , ref contact . Tangent , ref common . InertiaA , ref maximumTangentImpulse , ref contactImpulse . Tangent , ref wsvA ) ;
281
281
PenetrationLimitOneBody . Solve ( contact . Penetration , common . InertiaA , contact . Normal , common . SoftnessImpulseScale ,
@@ -323,7 +323,7 @@ public void Prestep(Bodies bodies, ref TwoBodyReferences bodyReferences, int cou
323
323
ref var prestepContact = ref Unsafe . Add ( ref prestepContactStart , i ) ;
324
324
ref var projectionContact = ref Unsafe . Add ( ref projectionContactStart , i ) ;
325
325
projectionContact . Normal = prestepContact . Normal ;
326
- Helpers . BuildOrthnormalBasis ( prestepContact . Normal , out var x , out var z ) ;
326
+ Helpers . BuildOrthonormalBasis ( prestepContact . Normal , out var x , out var z ) ;
327
327
Vector3Wide . Subtract ( prestepContact . Offset , prestepOffsetB , out var contactOffsetB ) ;
328
328
TangentFriction . Prestep ( ref x , ref z , ref prestepContact . Offset , ref contactOffsetB , ref projectionCommon . InertiaA , ref projectionCommon . InertiaB , out projectionContact . Tangent ) ;
329
329
PenetrationLimit . Prestep ( projectionCommon . InertiaA , projectionCommon . InertiaB ,
@@ -345,7 +345,7 @@ public unsafe void WarmStart(ref BodyVelocities wsvA, ref BodyVelocities wsvB, r
345
345
{
346
346
ref var contact = ref Unsafe . Add ( ref contactStart , i ) ;
347
347
ref var contactImpulse = ref Unsafe . Add ( ref accumulatedImpulsesStart , i ) ;
348
- Helpers . BuildOrthnormalBasis ( contact . Normal , out var x , out var z ) ;
348
+ Helpers . BuildOrthonormalBasis ( contact . Normal , out var x , out var z ) ;
349
349
TangentFriction . WarmStart ( ref x , ref z , ref contact . Tangent , ref common . InertiaA , ref common . InertiaB , ref contactImpulse . Tangent , ref wsvA , ref wsvB ) ;
350
350
PenetrationLimit . WarmStart ( contact . Penetration , common . InertiaA , common . InertiaB , contact . Normal , contactImpulse . Penetration , ref wsvA , ref wsvB ) ;
351
351
}
@@ -363,7 +363,7 @@ public void Solve(ref BodyVelocities wsvA, ref BodyVelocities wsvB, ref TProject
363
363
{
364
364
ref var contact = ref Unsafe . Add ( ref contactStart , i ) ;
365
365
ref var contactImpulse = ref Unsafe . Add ( ref accumulatedImpulsesStart , i ) ;
366
- Helpers . BuildOrthnormalBasis ( contact . Normal , out var x , out var z ) ;
366
+ Helpers . BuildOrthonormalBasis ( contact . Normal , out var x , out var z ) ;
367
367
var maximumTangentImpulse = common . FrictionCoefficient * contactImpulse . Penetration ;
368
368
TangentFriction . Solve ( ref x , ref z , ref contact . Tangent , ref common . InertiaA , ref common . InertiaB , ref maximumTangentImpulse , ref contactImpulse . Tangent , ref wsvA , ref wsvB ) ;
369
369
PenetrationLimit . Solve ( contact . Penetration , common . InertiaA , common . InertiaB , contact . Normal , common . SoftnessImpulseScale , ref contactImpulse . Penetration , ref wsvA , ref wsvB ) ;
0 commit comments