124 lines
9.2 KiB
C#
124 lines
9.2 KiB
C#
using System.Numerics;
|
|
using GamePort.Game;
|
|
using GamePort.Assets;
|
|
|
|
void Check(bool value, string message) { if (!value) throw new Exception(message); }
|
|
void Near(Vector3 actual, Vector3 expected, string message) =>
|
|
Check(Vector3.Distance(actual,expected)<.002f,$"{message}: {actual} != {expected}");
|
|
var floor=new CameraRayPolygon(new(new(-1000,0,-1000),new(1000,0,-1000),new(0,0,1000)),Vector3.UnitY);
|
|
var physics=new OriginalBodyPhysics(new([floor]));
|
|
OrdinaryBodyState Initial() => new(new(0,75.9f,0),Vector3.Zero,Vector3.Zero,Vector3.Zero);
|
|
// References observed from copied479D20/support, body-probe/wine.log.
|
|
var cases=new (string Name,OrdinaryBodyState Input,Vector3 Position,Vector3 Velocity,float AngularY,bool Supported,float? LandingY,bool Geometry)[] {
|
|
("floor_support",Initial(),new(0,75.9000015f,0),Vector3.Zero,0,true,-13.333334f,true),
|
|
("spawn_settle",Initial() with {Position=new(0,26,0)},new(0,75.9000015f,0),Vector3.Zero,0,true,-13.333334f,true),
|
|
("pending_jump",Initial() with {Supported=true,Impulse=new(0,550,0),Acceleration=new(0,-264,0)},new(0,84.7711105f,0),new(0,532.266663f,0),0,false,null,true),
|
|
("fall_above_floor",Initial() with {Position=new(0,100,0),Velocity=new(0,-200,0)},new(0,96.4444427f,0),new(0,-213.333328f,0),0,false,null,true),
|
|
("fall_land",Initial() with {Position=new(0,76,0),Velocity=new(0,-200,0)},new(0,75.9000015f,0),Vector3.Zero,0,true,-213.333328f,true),
|
|
("ground_friction",Initial() with {Velocity=new(100,0,50),AngularVelocity=new(0,12,0)},new(1.66666675f,75.9000015f,.833333373f),new(98.6666641f,0,49.3333321f),11.8400002f,true,-13.333334f,true),
|
|
("published_speed",Initial() with {Velocity=new(100,0,50),AngularVelocity=new(0,12,0),PublishedSpeed=100},new(1.66666675f,75.9000015f,.833333373f),new(100,0,50),12,true,-13.333334f,true),
|
|
("stationary_angular",Initial() with {AngularVelocity=new(0,12,0)},new(0,75.9000015f,0),Vector3.Zero,12,true,-13.333334f,true),
|
|
("small_motion",Initial() with {Velocity=new(.125f,0,0)},new(.00208333344f,75.9000015f,0),Vector3.Zero,0,true,-13.333334f,true),
|
|
("geometry_disabled",Initial() with {Velocity=new(0,200,0),Acceleration=new(0,-264,0)},new(0,75.9000015f,0),Vector3.Zero,0,true,null,false)
|
|
};
|
|
foreach(var test in cases)
|
|
{
|
|
var result=physics.Step(test.Input,1f/60,geometryEnabled:test.Geometry);
|
|
Near(result.Body.Position,test.Position,$"{test.Name} root");
|
|
Near(result.Body.Velocity,test.Velocity,$"{test.Name} velocity");
|
|
Near(result.Body.AngularVelocity,new(0,test.AngularY,0),$"{test.Name} angular velocity");
|
|
Near(result.Body.Impulse,Vector3.Zero,$"{test.Name} consumes impulse");
|
|
var expectedAcceleration=test.Geometry ? test.Supported ? Vector3.Zero : test.Input.Acceleration : new Vector3(0,800,0);
|
|
Near(result.Body.Acceleration,expectedAcceleration,$"{test.Name} acceleration");
|
|
Check(result.Body.Supported==test.Supported && result.Landing.HasValue==test.LandingY.HasValue,$"{test.Name} support/landing");
|
|
if(test.LandingY is {} vy)
|
|
{
|
|
var observation=result.Landing!.Value;
|
|
Check(!observation.Supported && MathF.Abs(observation.Velocity.Y-vy)<.002f,$"{test.Name} callback sees old velocity/support");
|
|
Check(observation.Acceleration.Y==0 && observation.Position==result.Body.Position,$"{test.Name} callback sees new root/acceleration");
|
|
}
|
|
Console.WriteLine($"PASS original ordinary-body reference {test.Name}");
|
|
}
|
|
var resting=physics.Step(Initial() with {Supported=true},1f/60);
|
|
Check(resting.Body.Supported && resting.Landing==null,"already supported must not emit landing37C again");
|
|
Console.WriteLine("PASS prior support suppresses repeated landing callback");
|
|
var empty=new OriginalBodyPhysics(new([]));
|
|
var rotation=empty.Step(Initial() with {AngularVelocity=new(0,.1f,0)},.5f);
|
|
Near(rotation.Body.Rotation,new(0,.05f,0),"rotation is integrated before small angular motion is suppressed");
|
|
Check(rotation.Body.AngularVelocity==Vector3.Zero,"small angular suppression");
|
|
var moving=empty.Step(Initial() with {Velocity=new(.125f,0,0),PublishedSpeed=1},1f/60,geometryEnabled:false);
|
|
Check(moving.Body.Velocity.X!=0,"nonzero published speed suppresses friction and small linear cutoff");
|
|
Console.WriteLine("PASS angular integration and independent published speed cutoff");
|
|
try { new OriginalBodyPhysics(new([floor with {StoredNormal=Vector3.UnitZ,MaterialId=61}]));
|
|
throw new Exception("unsupported special contacts accepted"); }
|
|
catch(NotSupportedException) { }
|
|
Console.WriteLine("PASS unsupported special-contact scene rejected");
|
|
var falling=empty.Step(Initial(),1f/60);
|
|
var rising=empty.Step(Initial() with {Impulse=new(0,550,0)},1f/60);
|
|
Check(falling.CollisionPasses==0 && rising.CollisionPasses==1,
|
|
"falling vertical motion is added after horizontal dispatcher; rising motion is dispatched whole");
|
|
Console.WriteLine("PASS positive-Y versus horizontal-first split");
|
|
var ceiling=new CameraRayPolygon(new(new(-100,100,-100),new(100,100,100),new(100,100,-100)), -Vector3.UnitY);
|
|
var roof=new OriginalBodyPhysics(new([ceiling]));
|
|
var roofHit=roof.Step(new(new(0,80,0),new(0,920,0),new(0,100,0),Vector3.Zero),1f/60,10,1);
|
|
Near(roofHit.Body.Position,new(0,90,0),"ceiling candidate published after terminal callback370");
|
|
Check(roofHit.Contact==ceiling && roofHit.Body.Velocity.Y==0 && roofHit.Body.Acceleration.Y==0,
|
|
"370 clears positive vertical velocity and acceleration without landing");
|
|
Check(!roofHit.Body.Supported && roofHit.Landing==null,"ceiling does not invent floor support");
|
|
Console.WriteLine("PASS composed ceiling370 and support ownership");
|
|
var wide=physics.Step(Initial(),1f/60,100);
|
|
Near(wide.Body.Position,new(0,126.5f,0),"live radius100 changes support offset as well as collision");
|
|
var unclamped=empty.Step(Initial() with {Velocity=new(100,0,0)},.5f,friction:4,geometryEnabled:false);
|
|
Near(unclamped.Body.Velocity,new(-100,0,0),"source friction multiplier is not clamped");
|
|
Console.WriteLine("PASS radius-dependent support and unclamped friction");
|
|
var original=Path.GetFullPath(args.Length==1?args[0]:"../Original");
|
|
var world=Mesh.LoadSceneJson("artifacts/extracted/VR04/scene.json");
|
|
var level=GamLevel.Load(AssetPath.Resolve(original,"gam/VR04.gam"));
|
|
var start=level.FindStart()!;
|
|
var standing=AseMesh.Load(AssetPath.Resolve(original,"ASE/jimstop.ase"));
|
|
var geometry=OriginalCameraRay.FromRouteScene(world,"VR04");
|
|
LabSimulation Simulation(bool retained=false) => new(new(world),standing,start.Position,start.Rotation.Y,
|
|
(a,b)=>geometry.Trace(a,b),(a,b)=>geometry.TraceGeometry(a,b),OriginalStaticCollision.FromRouteScene(world,"VR04"))
|
|
{LevelCode="VR04",InputAfterPlayerUpdate=retained};
|
|
var player=Simulation();
|
|
Check(player.UsesOriginalBody && player.PublishedSpeed==0,"tutorial explicitly selects source body");
|
|
for(var i=0;i<120;i++)player.Step(default);
|
|
Check(player.Grounded && player.Landings==0,"steady source support must not chatter");
|
|
var sole=standing.Vertices.Min(v=>Vector3.Transform(v.Position,player.Model).Y);
|
|
Check(MathF.Abs(sole-player.Position.Y)<.001f,"modern sole/root render bridge remains explicit and stable");
|
|
var rootBefore=player.ActorRoot;
|
|
player.Step(new(false,false,false,false,true));
|
|
Check(player.PendingImpulse.Y==550 && player.Grounded,"controller queues takeoff after body");
|
|
player.Step(default,false);
|
|
Check(player.PendingImpulse==Vector3.Zero && !player.Grounded && player.ActorRoot.Y>rootBefore.Y
|
|
&& player.ControllerSteps==121 && player.PhysicsSteps==122,"body consumes jump without control ownership");
|
|
Console.WriteLine("PASS tutorial root/visual bridge and control-independent pending jump");
|
|
player=Simulation();
|
|
for(var i=0;i<8;i++)player.Step(new(true,false,false,false,false));
|
|
var published=player.PublishedSpeed;
|
|
Check(published>0 && published==player.Speed,"controlled tail publishes controller speed");
|
|
player.PrepareForScript();
|
|
Check(player.Speed==0 && player.PublishedSpeed==published,"preparation preserves previously published speed160");
|
|
player.Step(default,false);
|
|
Check(player.PublishedSpeed==published,"raw control gate prevents new publication");
|
|
player.Step(default);
|
|
Check(player.PublishedSpeed==player.Speed,"resumed controlled tail publishes again");
|
|
Console.WriteLine("PASS tutorial published speed/preparation/control boundaries");
|
|
player=Simulation(true);
|
|
Check(player.ApplyRetainedLevelState(new("LV1B",3,1,.6f,4)),"retained tutorial scalar state accepted");
|
|
Check(player.PublishedSpeed==0 && player.Velocity==Vector3.Zero,"scene Init resets published body/controller motion");
|
|
for(var i=0;i<300;i++)player.Step(LabSimulation.JetpackSmokeInput(i));
|
|
Check(player.Bursts>0 && player.Travel>50 && player.MaximumRise>100 && player.Energy==20,
|
|
"retained input ordering keeps powered steering and VR04 energy exemption");
|
|
Check(player.Grounded && player.Landings>0,"source tutorial powered flight returns to support");
|
|
Console.WriteLine("PASS retained tutorial jetpack/steering/landing phases");
|
|
player=Simulation();
|
|
player.SetNoclip(true);
|
|
player.Step(new(false,false,false,false,false,Rise:true));
|
|
var physicsSteps=player.PhysicsSteps;
|
|
player.SetNoclip(false);
|
|
player.Step(default,false);
|
|
Check(player.PhysicsSteps==physicsSteps+1 && player.PublishedSpeed==0,"modern noclip exits into source body with cleared motion");
|
|
Console.WriteLine("PASS tutorial noclip returns to source body");
|
|
Console.WriteLine("Ordinary body:20 groups passed; dynamic actors and special Player contacts remain separate.");
|