complete project reorganization

scenes/player_controller/components/mantle/MantleSystem.cs

@@ -0,0 +1,114 @@
+using Godot;
+using RustyOptions;
+
+namespace Movementtests.systems;
+
+[GlobalClass, Icon("res://assets/ui/IconGodotNode/node_3D/icon_follower.png")]
+public partial class MantleSystem: Node3D
+{
+    [Export(PropertyHint.Range, "0,2,0.01,suffix:m,or_greater")]
+    public float MantleEndLocationDistanceFromWall { get; set; } = 1f;
+    [Export(PropertyHint.Range, "0,10,0.1,suffix:m,or_greater")]
+    public float MantleHeightCastStart { get; set; } = 2f;
+    [Export(PropertyHint.Range, "0,10,0.01,suffix:m,or_greater")]
+    public float MaxStepHeight = 0.5f;
+    
+    private ShapeCast3D _wallInFrontCast3D;
+    private ShapeCast3D _mantleCast3D;
+
+    private ShapeCast3D _inAirWallDetect;
+    private ShapeCast3D _groundedWallDetect;
+    public Curve3D MantleCurve { get; private set; }
+    public Vector3 FirstMantleProfilePoint { get; private set; } = Vector3.Zero;
+    
+    public bool IsMantlePossible { get; private set; } = false;
+    public bool EndedOnOtherSideOfWall { get; private set; } = false;
+    public bool FoundGround { get; private set; } = false;
+    public const int WallProfileCastCount = 7;
+    
+    private ShapeCast3D[] _wallProfileShapecasts = new ShapeCast3D[WallProfileCastCount];
+
+    public void Init()
+    {
+        _wallInFrontCast3D = GetNode<ShapeCast3D>("WallInFrontCast3D");
+        _mantleCast3D = GetNode<ShapeCast3D>("MantleCast3D");
+        
+        _inAirWallDetect = GetNode<ShapeCast3D>("InAirWallDetect");
+        _groundedWallDetect = GetNode<ShapeCast3D>("GroundedWallDetect");
+        for (int i = 0; i < _wallProfileShapecasts.Length; i++)
+        {
+            _wallProfileShapecasts[i] = GetNode<ShapeCast3D>($"WallProfileShapeCasts/ShapeCast{i + 1}");
+        }
+    }
+
+    private void SetCastsEnabled(bool enabled)
+    {
+        foreach (var wallProfileShapecast in _wallProfileShapecasts)
+        {
+            wallProfileShapecast.SetEnabled(enabled);
+        }
+    }
+
+    public void ProcessMantle(bool isGrounded)
+    {
+        _inAirWallDetect.SetEnabled(!isGrounded);
+        _groundedWallDetect.SetEnabled(isGrounded);
+        var isColliding = _inAirWallDetect.IsColliding() || _groundedWallDetect.IsColliding(); 
+        SetCastsEnabled(isColliding);
+        
+        // Reset state
+        IsMantlePossible = false;
+        EndedOnOtherSideOfWall = false;
+        FoundGround = false;
+        if (!isColliding) return;
+        
+        // Check if face something wall-like that should be climbable 
+        var collisionNormal = isGrounded ? _groundedWallDetect.GetCollisionNormal(0) : _inAirWallDetect.GetCollisionNormal(0);
+        if (collisionNormal.Y > 0.7f) return;
+        
+        var spaceState = GetWorld3D().DirectSpaceState;
+        
+        MantleCurve = new Curve3D();
+        MantleCurve.AddPoint(Vector3.Zero);
+        var hasFirstProfileHit = false; 
+        var previousProfilePoint = GlobalPosition;
+        foreach (var wallProfileShapecast in _wallProfileShapecasts)
+        {
+            // Haven't met the wall yet
+            if (!wallProfileShapecast.IsColliding() && !hasFirstProfileHit) continue;
+            
+            var globalTargetPosition = wallProfileShapecast.GlobalPosition + wallProfileShapecast.TargetPosition;
+            
+            // Got to the other side of the wall, we stop there
+            if (!wallProfileShapecast.IsColliding())
+            {
+                break;
+            }
+
+            var profilePoint = wallProfileShapecast.GetCollisionPoint(0);
+            var profileNormal = wallProfileShapecast.GetCollisionNormal(0);
+            var shape = wallProfileShapecast.Shape as SphereShape3D;
+            var shapeRadius = shape == null ? 0.125f : shape.Radius;
+            var centerOfShape = profilePoint + profileNormal * shapeRadius;
+            
+            // Check if we collided parallel to a wall
+            var isCollisionSameAsTarget = globalTargetPosition.IsEqualApprox(centerOfShape);
+            var isCollidingWithWall = profileNormal.Y < 0.1f;
+            if (isCollisionSameAsTarget || isCollidingWithWall) continue;
+            
+            // Check if the path from the previous point makes us go through a wall
+            var query = PhysicsRayQueryParameters3D.Create(previousProfilePoint, centerOfShape, wallProfileShapecast.CollisionMask);
+            var result = spaceState.IntersectRay(query);
+            if (result.Count > 0) break; // We are going through a wall, we stop there
+            
+            // We have a valid collision
+            if (!hasFirstProfileHit) FirstMantleProfilePoint = centerOfShape;
+            hasFirstProfileHit = true;
+            previousProfilePoint = centerOfShape;
+            MantleCurve.AddPoint(ToLocal(centerOfShape));
+        }
+        if (MantleCurve.PointCount == 1) return;
+        
+        IsMantlePossible = true;
+    }
+}

scenes/player_controller/components/mantle/MantleSystem.cs.uid

@@ -0,0 +1 @@
+uid://bja6tis1vaysu

scenes/player_controller/components/mantle/find_wall_shape.tres

@@ -0,0 +1,4 @@
+[gd_resource type="SphereShape3D" format=3 uid="uid://dp2p8v7demb5j"]
+
+[resource]
+radius = 0.25

scenes/player_controller/components/mantle/mantle_system.tscn

@@ -0,0 +1,104 @@
+[gd_scene format=3 uid="uid://wq1okogkhc5l"]
+
+[ext_resource type="Script" uid="uid://bja6tis1vaysu" path="res://scenes/player_controller/components/mantle/MantleSystem.cs" id="1_2oobp"]
+
+[sub_resource type="CapsuleShape3D" id="CapsuleShape3D_4coqe"]
+height = 1.7
+
+[sub_resource type="SphereShape3D" id="SphereShape3D_2oobp"]
+radius = 0.75
+
+[sub_resource type="CapsuleShape3D" id="CapsuleShape3D_2oobp"]
+radius = 0.25
+
+[sub_resource type="CapsuleShape3D" id="CapsuleShape3D_i32qj"]
+radius = 0.25
+height = 1.5
+
+[sub_resource type="SphereShape3D" id="SphereShape3D_i32qj"]
+radius = 0.125
+
+[node name="MantleSystem" type="Node3D" unique_id=1117790260]
+script = ExtResource("1_2oobp")
+MantleEndLocationDistanceFromWall = 0.2
+MantleHeightCastStart = 3.0
+
+[node name="MantleCast3D" type="ShapeCast3D" parent="." unique_id=977434819]
+visible = false
+shape = SubResource("CapsuleShape3D_4coqe")
+target_position = Vector3(0, 0, 0)
+max_results = 1
+collision_mask = 256
+debug_shape_custom_color = Color(1, 0, 0, 1)
+
+[node name="WallInFrontCast3D" type="ShapeCast3D" parent="." unique_id=774357590]
+transform = Transform3D(1, 0, 0, 0, 1, 0, 0, 0, 1, 0, 1, 0)
+visible = false
+shape = SubResource("SphereShape3D_2oobp")
+target_position = Vector3(0, 0, -1.5)
+max_results = 1
+collision_mask = 256
+debug_shape_custom_color = Color(0.911631, 0.11884, 0.656218, 1)
+
+[node name="InAirWallDetect" type="ShapeCast3D" parent="." unique_id=276043236]
+transform = Transform3D(1, 0, 0, 0, 1, 0, 0, 0, 1, 0, 1.01, 0)
+shape = SubResource("CapsuleShape3D_2oobp")
+target_position = Vector3(0, 0, -2)
+collision_mask = 256
+
+[node name="GroundedWallDetect" type="ShapeCast3D" parent="." unique_id=1673208243]
+transform = Transform3D(1, 0, 0, 0, 1, 0, 0, 0, 1, 0, 1.26, 0)
+shape = SubResource("CapsuleShape3D_i32qj")
+target_position = Vector3(0, 0, -2)
+collision_mask = 256
+
+[node name="WallProfileShapeCasts" type="Node3D" parent="." unique_id=857147957]
+
+[node name="ShapeCast1" type="ShapeCast3D" parent="WallProfileShapeCasts" unique_id=1271662121]
+transform = Transform3D(1, 0, 0, 0, 1, 0, 0, 0, 1, 0, 2.5, -0.5)
+enabled = false
+shape = SubResource("SphereShape3D_i32qj")
+target_position = Vector3(0, -2.125, 0)
+collision_mask = 256
+
+[node name="ShapeCast2" type="ShapeCast3D" parent="WallProfileShapeCasts" unique_id=147611166]
+transform = Transform3D(1, 0, 0, 0, 1, 0, 0, 0, 1, 0, 2.5, -0.75)
+enabled = false
+shape = SubResource("SphereShape3D_i32qj")
+target_position = Vector3(0, -2.125, 0)
+collision_mask = 256
+
+[node name="ShapeCast3" type="ShapeCast3D" parent="WallProfileShapeCasts" unique_id=1248645023]
+transform = Transform3D(1, 0, 0, 0, 1, 0, 0, 0, 1, 0, 2.5, -1)
+enabled = false
+shape = SubResource("SphereShape3D_i32qj")
+target_position = Vector3(0, -2.125, 0)
+collision_mask = 256
+
+[node name="ShapeCast4" type="ShapeCast3D" parent="WallProfileShapeCasts" unique_id=839558141]
+transform = Transform3D(1, 0, 0, 0, 1, 0, 0, 0, 1, 0, 2.5, -1.25)
+enabled = false
+shape = SubResource("SphereShape3D_i32qj")
+target_position = Vector3(0, -2.125, 0)
+collision_mask = 256
+
+[node name="ShapeCast5" type="ShapeCast3D" parent="WallProfileShapeCasts" unique_id=886271592]
+transform = Transform3D(1, 0, 0, 0, 1, 0, 0, 0, 1, 0, 2.5, -1.5)
+enabled = false
+shape = SubResource("SphereShape3D_i32qj")
+target_position = Vector3(0, -2.125, 0)
+collision_mask = 256
+
+[node name="ShapeCast6" type="ShapeCast3D" parent="WallProfileShapeCasts" unique_id=1927435390]
+transform = Transform3D(1, 0, 0, 0, 1, 0, 0, 0, 1, 0, 2.5, -1.75)
+enabled = false
+shape = SubResource("SphereShape3D_i32qj")
+target_position = Vector3(0, -2.125, 0)
+collision_mask = 256
+
+[node name="ShapeCast7" type="ShapeCast3D" parent="WallProfileShapeCasts" unique_id=2112972214]
+transform = Transform3D(1, 0, 0, 0, 1, 0, 0, 0, 1, 0, 2.5, -2)
+enabled = false
+shape = SubResource("SphereShape3D_i32qj")
+target_position = Vector3(0, -2.125, 0)
+collision_mask = 256