コード例 #1
0
        private static bool CollideWithTerrainAABB(int axis, AABB aabb, IWorld world, PhysicMaterial material, float time, ref float velocity, out float movement)
        {
            movement = velocity * time;

            if (movement == 0)
            {
                return(false);
            }

            Vector3Int start = default;
            Vector3Int end   = default;
            Vector3Int step  = default;

            if (movement > 0)
            {
                for (int i = 0; i < 3; i++)
                {
                    if (axis == i)
                    {
                        start[i] = Mathf.FloorToInt(aabb.Max[i]);
                        end[i]   = Mathf.FloorToInt(aabb.Max[i] + movement);
                    }
                    else
                    {
                        start[i] = Mathf.FloorToInt(aabb.Min[i]);
                        end[i]   = Mathf.FloorToInt(aabb.Max[i]);
                    }

                    step[i] = 1;
                }
            }
            else
            {
                for (int i = 0; i < 3; i++)
                {
                    if (axis == i)
                    {
                        end[i]  = Mathf.FloorToInt(aabb.Min[i] + movement);
                        step[i] = -1;
                    }
                    else
                    {
                        end[i]  = Mathf.FloorToInt(aabb.Max[i]);
                        step[i] = 1;
                    }

                    start[i] = Mathf.FloorToInt(aabb.Min[i]);
                }
            }

            end += step;

            for (int x = start.x; x != end.x; x += step.x)
            {
                for (int z = start.z; z != end.z; z += step.z)
                {
                    for (int y = start.y; y != end.y; y += step.y)
                    {
                        BlockData block     = world.RWAccessor.GetBlock(x, y, z);
                        AABB?     blockAABB = block.GetBoundingBox(x, y, z, world, true);

                        if (blockAABB == null)
                        {
                            continue;
                        }

                        AABB blockBB = blockAABB.Value;
                        bool flag    = true;

                        for (int i = 0; i < 3; i++)
                        {
                            if (i != axis)
                            {
                                flag &= blockBB.Max[i] > aabb.Min[i] && blockBB.Min[i] < aabb.Max[i];
                            }
                        }

                        if (!flag)
                        {
                            continue;
                        }

                        if (movement > 0 && aabb.Max[axis] <= blockBB.Min[axis])
                        {
                            float maxMovement = blockBB.Min[axis] - aabb.Max[axis];

                            if (movement > maxMovement)
                            {
                                CalculateVelocityAfterCollisionWithTerrain(material, block, ref velocity);
                                movement = maxMovement;
                                return(true);
                            }
                        }
                        else if (movement < 0 && aabb.Min[axis] >= blockBB.Max[axis])
                        {
                            float maxMovement = blockBB.Max[axis] - aabb.Min[axis];

                            if (movement < maxMovement)
                            {
                                CalculateVelocityAfterCollisionWithTerrain(material, block, ref velocity);
                                movement = maxMovement;
                                return(true);
                            }
                        }
                    }
                }
            }

            return(false);
        }
コード例 #2
0
        public static CollisionFlags CollideWithTerrainAABB(Vector3 position, AABB aabb, IWorld world, PhysicMaterial material, float time, ref Vector3 velocity, out Vector3 movement)
        {
            aabb += position;

            for (int i = 0; i < 3; i++)
            {
                if (Mathf.Abs(velocity[i]) <= Mathf.Epsilon)
                {
                    velocity[i] = 0;
                }
            }

            CollisionFlags flags     = CollisionFlags.None;
            bool           negativeY = velocity.y < 0;

            movement = default;

            if (CollideWithTerrainAABB(1, aabb, world, material, time, ref velocity.y, out movement.y))
            {
                flags |= negativeY ? CollisionFlags.Below : CollisionFlags.Above;
            }

            aabb += new Vector3(0, movement.y, 0);

            if (CollideWithTerrainAABB(0, aabb, world, material, time, ref velocity.x, out movement.x))
            {
                flags |= CollisionFlags.Sides;
            }

            aabb += new Vector3(movement.x, 0, 0);

            if (CollideWithTerrainAABB(2, aabb, world, material, time, ref velocity.z, out movement.z))
            {
                flags |= CollisionFlags.Sides;
            }

            return(flags);
        }