private void ResetGrounds() { primaryGround = new GroundHit(); nearGround = new GroundHit(); farGround = new GroundHit(); flushGround = new GroundHit(); stepGround = new GroundHit(); }
private void HandleEdgeCollision(CollisionSphere collisionSphere, RaycastHit hit) { Vector3 towardCenter = Math3d.ProjectVectorOnPlane( playerView.Up, (playerView.Position - hit.point).normalized * settings.epsilon ); Quaternion planeAwayRotation = Quaternion.AngleAxis( settings.edgeCollisionRotateDegree, Vector3.Cross(towardCenter, playerView.Up) ); Vector3 awayCenter = planeAwayRotation * -towardCenter; Vector3 nearPoint = hit.point + towardCenter + (playerView.Up * settings.epsilon); Vector3 farPoint = hit.point + (awayCenter * settings.edgeCollisionFarPointMultiplier); RaycastHit nearHit; RaycastHit farHit; Raycast(nearPoint, playerView.Down, out nearHit); Raycast(farPoint, playerView.Down, out farHit); nearGround = new GroundHit(nearHit); farGround = new GroundHit(farHit); // If we are standing on surface that should be counted as a // wall, attempt to flush against it on the ground if (Vector3.Angle(hit.normal, playerView.Up) > collidable.StandAngle) { FlushGround(collisionSphere, hit); } // If we are standing on a ledge then face the nearest center of // the player view, which should be steep enough to be counted as // a wall. Retrieve the ground it is connected to at its base, if // there is one. if ((Vector3.Angle(nearHit.normal, playerView.Up) > collidable.StandAngle) || (nearHit.distance > settings.tolerance)) { Collidable nearCollidable = GetCollidable(nearHit); if (Vector3.Angle(nearHit.normal, playerView.Up) > nearCollidable.StandAngle) { Vector3 downslopeDirection = CollisionMath.DownslopeDirection(nearHit.normal, playerView.Down); RaycastHit stepHit; if (Raycast(nearPoint, downslopeDirection, out stepHit)) { stepGround = new GroundHit(stepHit); } } else { stepGround = new GroundHit(nearHit); } } }
private void DebugGround(GroundHit groundHit, Color color) { if (groundHit.isFound) { DebugDraw.DrawVector( groundHit.point, groundHit.normal, 2f, 1f, color, 0, false ); } }
private void HandleClippingCollision(CollisionSphere collisionSphere, RaycastHit hit) { collidable = GetCollidable(hit); transform = hit.transform; RaycastHit sphereCastHit; if (SimulateSphereCast(collisionSphere, hit.normal, out sphereCastHit)) { primaryGround = new GroundHit(sphereCastHit); } else { primaryGround = new GroundHit(hit); } }
/* * Scans surface below controller for ground. Follows up the initial * scan with subsequent scans to handle different edge cases. */ public void ProbeGround(CollisionSphere collisionSphere) { ResetGrounds(); Vector3 origin = collisionSphere.Position + (playerView.Up * settings.tolerance); // Reduce radius to avoid failing SphereCast due to wall clipping float smallerRadius = collisionSphere.Radius - (settings.tolerance * settings.tolerance); RaycastHit hit; if (SphereCast(origin, smallerRadius, playerView.Down, out hit)) { collidable = GetCollidable(hit); transform = hit.transform; SimulateSphereCast(collisionSphere, hit.normal, out hit); primaryGround = new GroundHit(hit); // If we are standing on a perfectly flat surface, we cannot be // either on an edge, on a slope, or stepping off a ledge Vector3 surface = Math3d.ProjectPointOnPlane(playerView.Up, playerView.Position, hit.point); if (Vector3.Distance(surface, playerView.Position) < settings.epsilon) { return; } // Now the collision is on an edge, so normals of the two faces // on either side of the edge are computed and stored in nearHit // and farHit HandleEdgeCollision(collisionSphere, hit); } // If initial SphereCast fails, which is likely due to controller // clipping a wall, fallback to raycast simulating SphereCast data else if (Raycast(origin, playerView.Down, out hit)) { HandleClippingCollision(collisionSphere, hit); } else { Debug.Log("No ground found below player"); } }
private void FlushGround(CollisionSphere collisionSphere, RaycastHit hit) { Vector3 downslopeDirection = CollisionMath.DownslopeDirection(hit.normal, playerView.Down); Vector3 flushOrigin = hit.point + (hit.normal * settings.epsilon); RaycastHit flushHit; if (Raycast(flushOrigin, downslopeDirection, out flushHit)) { RaycastHit sphereCastHit; if (SimulateSphereCast(collisionSphere, flushHit.normal, out sphereCastHit)) { flushGround = new GroundHit(sphereCastHit); } else { Debug.Log("Failed to flush against ground"); } } }
private bool IsGroundStandable(GroundHit groundHit) { return(Vector3.Angle(groundHit.normal, playerView.Up) < collidable.StandAngle); }