starting slope stuff

Assets/Scripts/MoveController.cs

@@ -9,7 +9,6 @@ public class MoveController : MonoBehaviour
     public const float skinWidth = 0.015f;
     public int horizontalRayCount = 4;
     public int verticalRayCount = 4;
-    public int forwardRayCount = 4;
     public CollisionInfo collisions;
     public float maxClimbAngle = 80f;
 
@@ -17,7 +16,6 @@ public class MoveController : MonoBehaviour
     private RaycastOrigins raycastOrigins;
     private float horizontalRaySpacing;
     private float verticalRaySpacing;
-    private float forwardRaySpacing;
 
     void Start() {
         collider = GetComponent<BoxCollider>();
@@ -28,25 +26,22 @@ public class MoveController : MonoBehaviour
         UpdateRaycastOrigins();
         collisions.Reset();
 
+        if (velocity.x != 0) {
             HorizontalCollisions(ref velocity);
+        }
+        if (velocity.y != 0) {
             VerticalCollisions(ref velocity);
-        // if (velocity.x != 0) {
-        // }
-        // if (velocity.y != 0) {
-        // }
+        }
         transform.Translate(velocity);
     }
 
     private void HorizontalCollisions(ref Vector3 velocity) {
-        // https://www.youtube.com/watch?v=cwcC2tIKObU&t=331s
         float directionX = Mathf.Sign(velocity.x);           // -1 for left, 1 for right
         float rayLength = Mathf.Abs(velocity.x) + skinWidth;
 
         for (int i = 0; i < horizontalRayCount; i++) {
-            for (int j = 0; j < forwardRayCount; j++) {
-                Vector3 rayOrigin = (directionX == -1) ? raycastOrigins.bottomFrontLeft : raycastOrigins.bottomFrontRight;
+            Vector3 rayOrigin = (directionX == -1) ? raycastOrigins.bottomLeft : raycastOrigins.bottomRight;
             rayOrigin += Vector3.up * (horizontalRaySpacing * i);
-                rayOrigin += Vector3.forward * (forwardRaySpacing * j);
 
             RaycastHit[] hits = Physics.RaycastAll(rayOrigin, Vector3.right * directionX, rayLength, collisionMask);
             if (hits.Length == 0) {
@@ -62,8 +57,9 @@ public class MoveController : MonoBehaviour
             }
 
             float slopeAngle = Vector3.Angle(hit.normal, Vector3.up);
-                if (i == 0 && j == 0) {
+            if (i == 0) {
                 Debug.LogFormat("Slope angle: {0}", slopeAngle);
+                ClimbSlope(ref velocity, slopeAngle);
             }
 
             velocity.x = (hit.distance - skinWidth) * directionX;
@@ -78,20 +74,17 @@ public class MoveController : MonoBehaviour
             }
         }
     }
-    }
 
     private void VerticalCollisions(ref Vector3 velocity) {
         float directionY = Mathf.Sign(velocity.y);           // -1 for down, 1 for up
         float rayLength = Mathf.Abs(velocity.y) + skinWidth;
 
         for (int i = 0; i < verticalRayCount; i++) {
-            for (int j = 0; j < forwardRayCount; j++) {
-                Vector3 rayOrigin = (directionY == -1) ? raycastOrigins.bottomFrontLeft : raycastOrigins.topFrontLeft;
+            Vector3 rayOrigin = (directionY == -1) ? raycastOrigins.bottomLeft : raycastOrigins.topLeft;
             rayOrigin += Vector3.right * (verticalRaySpacing * i);
-                rayOrigin += Vector3.forward * (forwardRaySpacing * j);
             RaycastHit[] hits = Physics.RaycastAll(rayOrigin, Vector3.up * directionY, rayLength, collisionMask);
             if (hits.Length == 0) {
-                    Debug.DrawRay(rayOrigin + velocity, Vector3.up * directionY * rayLength * 10, Color.green);
+                Debug.DrawRay(rayOrigin + velocity, Vector3.up * directionY * rayLength, Color.green);
                 continue;
             }
             RaycastHit hit = hits[0];
@@ -113,21 +106,22 @@ public class MoveController : MonoBehaviour
             }
         }
     }
+
+    private void ClimbSlope(ref Vector3 velocity, float slopeAngle) {
+        float dist = Mathf.Abs(velocity.x);
+        velocity.y = Mathf.Sin(slopeAngle * Mathf.Deg2Rad) * dist;
+        velocity.x = Mathf.Cos(slopeAngle * Mathf.Deg2Rad) * dist * Mathf.Sign(velocity.x);
     }
 
     void UpdateRaycastOrigins() {
         Bounds bounds = collider.bounds;
+        float depth = (bounds.max.z + bounds.min.z) * 0.5f;
         bounds.Expand(skinWidth * -2);
 
-        raycastOrigins.bottomFrontLeft = new Vector3(bounds.min.x, bounds.min.y, bounds.min.z);  // 0 0 0
-        raycastOrigins.bottomBackLeft = new Vector3(bounds.min.x, bounds.min.y, bounds.max.z);   // 0 0 1
-        raycastOrigins.topFrontLeft = new Vector3(bounds.min.x, bounds.max.y, bounds.min.z);     // 0 1 0
-        raycastOrigins.topBackLeft = new Vector3(bounds.min.x, bounds.max.y, bounds.max.z);      // 0 1 1
-
-        raycastOrigins.bottomFrontRight = new Vector3(bounds.max.x, bounds.min.y, bounds.min.z); // 1 0 0
-        raycastOrigins.bottomBackRight = new Vector3(bounds.max.x, bounds.min.y, bounds.max.z);  // 1 0 1
-        raycastOrigins.topFrontRight = new Vector3(bounds.max.x, bounds.max.y, bounds.min.z);    // 1 1 0
-        raycastOrigins.topBackRight = new Vector3(bounds.max.x, bounds.max.y, bounds.max.z);     // 1 1 1
+        raycastOrigins.bottomLeft = new Vector3(bounds.min.x, bounds.min.y, depth);
+        raycastOrigins.topLeft = new Vector3(bounds.min.x, bounds.max.y, depth);
+        raycastOrigins.bottomRight = new Vector3(bounds.max.x, bounds.min.y, depth);
+        raycastOrigins.topRight = new Vector3(bounds.max.x, bounds.max.y, depth);
     }
 
     void CalculateRaySpacing() {
@@ -136,24 +130,18 @@ public class MoveController : MonoBehaviour
 
         if (horizontalRayCount < 2) { horizontalRayCount = 2; }
         if (verticalRayCount < 2) { verticalRayCount = 2; }
-        if (forwardRayCount < 2) { forwardRayCount = 2; }
 
         horizontalRaySpacing = bounds.size.y / (horizontalRayCount - 1);
         verticalRaySpacing = bounds.size.x / (verticalRayCount - 1);
-        forwardRaySpacing = bounds.size.z / (forwardRayCount - 1);
     }
 
     public bool Grounded() { return collisions.below; }
 
     struct RaycastOrigins {
-        public Vector3 topBackLeft;
-        public Vector3 topBackRight;
-        public Vector3 topFrontLeft;
-        public Vector3 topFrontRight;
-        public Vector3 bottomBackLeft;
-        public Vector3 bottomBackRight;
-        public Vector3 bottomFrontLeft;
-        public Vector3 bottomFrontRight;
+        public Vector3 topLeft;
+        public Vector3 topRight;
+        public Vector3 bottomLeft;
+        public Vector3 bottomRight;
     }
 
     public struct CollisionInfo {