Minecraft-Console-Client/MinecraftClient/Mapping/Location.cs

using System;
using System.Globalization;
using System.Runtime.CompilerServices;

namespace MinecraftClient.Mapping
{
    /// <summary>
    /// Represents a location into a Minecraft world
    /// </summary>
    public struct Location
    {
        public static readonly Location Zero = new(0, 0, 0);

        /// <summary>
        /// The X Coordinate
        /// </summary>
        public double X;

        /// <summary>
        /// The Y Coordinate (vertical)
        /// </summary>
        public double Y;

        /// <summary>
        /// The Z coordinate
        /// </summary>
        public double Z;

        /// <summary>
        /// Identifies whether the coordinates are absolute or relative.
        /// true for relative coordinates, false for absolute coordinates.
        /// X-axis: ((Status & (1 << 0)) > 0)
        /// Y-axis: ((Status & (1 << 1)) > 0)
        /// Z-axis: ((Status & (1 << 2)) > 0)
        /// </summary>
        public byte Status;

        /// <summary>
        /// Create a new location
        /// </summary>
        public Location(double x, double y, double z)
        {
            X = x;
            Y = y;
            Z = z;
            Status = 0;
        }

        /// <summary>
        /// Create a new location
        /// </summary>
        public Location(double x, double y, double z, byte status)
        {
            X = x;
            Y = y;
            Z = z;
            Status = status;
        }

        /// <summary>
        /// Create a new location
        /// </summary>
        public Location(Location loc)
        {
            X = loc.X;
            Y = loc.Y;
            Z = loc.Z;
            Status = loc.Status;
        }

        /// <summary>
        /// Create a new location
        /// </summary>
        /// <param name="chunkX">Location of the chunk into the world</param>
        /// <param name="chunkZ">Location of the chunk into the world</param>
        /// <param name="blockX">Location of the block into the chunk</param>
        /// <param name="blockY">Location of the block into the world</param>
        /// <param name="blockZ">Location of the block into the chunk</param>
        [MethodImpl(MethodImplOptions.AggressiveInlining)]
        public Location(int chunkX, int chunkZ, int blockX, int blockY, int blockZ)
        {
            X = chunkX * Chunk.SizeX + blockX;
            Y = blockY;
            Z = chunkZ * Chunk.SizeZ + blockZ;
            Status = 0;
        }

        public Location ToAbsolute(Location based)
        {
            if ((Status & (1 << 0)) > 0)
                X += based.X;
            if ((Status & (1 << 1)) > 0)
                Y += based.Y;
            if ((Status & (1 << 2)) > 0)
                Z += based.Z;
            Status = 0;
            return this;
        }

        /// <summary>
        /// Parse location from the string.
        /// throw FormatException if the parsing fails.
        /// </summary>
        /// <param name="x">The string representation of the X-axis coordinate.</param>
        /// <param name="y">The string representation of the Y-axis coordinate.</param>
        /// <param name="z">The string representation of the Z-axis coordinate.</param>
        /// <returns>The location represented by the string.</returns>
        public static Location Parse(string x, string y, string z)
        {
            Location.TryParse(x, y, z, out Location? res);
            if (res == null)
                throw new FormatException();
            else
                return (Location)res;
        }

        public static bool TryParse(string x, string y, string z, out Location? location)
        {
            string[] coord_str = new string[] { x.Trim(), y.Trim(), z.Trim() };
            double[] coord_res = new double[3];

            for (int i = 0; i < 3; ++i)
            {
                if (!double.TryParse(coord_str[i], NumberStyles.Any, CultureInfo.CurrentCulture, out coord_res[i]))
                {
                    location = null;
                    return false;
                }
            }

            location = new Location(coord_res[0], coord_res[1], coord_res[2]);
            return true;
        }

        /// <summary>
        /// Parse location from the string (relative coordinate representation is supported).
        /// throw FormatException if the parsing fails.
        /// </summary>
        /// <param name="current">Relative position base point.</param>
        /// <param name="x">The string representation of the X-axis coordinate.</param>
        /// <param name="y">The string representation of the Y-axis coordinate.</param>
        /// <param name="z">The string representation of the Z-axis coordinate.</param>
        /// <returns>The location represented by the string.</returns>
        public static Location Parse(Location current, string x, string y, string z)
        {
            Location.TryParse(current, x, y, z, out Location? res);
            if (res == null)
                throw new FormatException();
            else
                return (Location)res;
        }

        public static bool TryParse(Location current, string x, string y, string z, out Location? location)
        {
            string[] coord_str = new string[] { x.Trim(), y.Trim(), z.Trim() };
            double[] coord_res = new double[3];
            double[] coord_cur = new double[] { current.X, current.Y, current.Z };

            for (int i = 0; i < 3; ++i)
            {
                if (coord_str[i].StartsWith('~'))
                {
                    if (coord_str[i].Length > 1)
                    {
                        if (!double.TryParse(coord_str[i][1..], NumberStyles.Any, CultureInfo.CurrentCulture, out coord_res[i]))
                        {
                            location = null;
                            return false;
                        }
                        coord_res[i] += coord_cur[i];
                    }
                    else
                        coord_res[i] = coord_cur[i];
                }
                else
                {
                    if (!double.TryParse(coord_str[i], NumberStyles.Any, CultureInfo.CurrentCulture, out coord_res[i]))
                    {
                        location = null;
                        return false;
                    }
                }
            }

            location = new Location(coord_res[0], coord_res[1], coord_res[2]);
            return true;
        }

        /// <summary>
        /// Round coordinates
        /// </summary>
        /// <returns>New location</returns>
        public Location ToFloor()
        {
            return new Location(Math.Floor(X), Math.Floor(Y), Math.Floor(Z));
        }

        /// <summary>
        /// Get the center coordinates
        /// </summary>
        /// <returns>New location</returns>
        public Location ToCenter()
        {
            return new Location(Math.Floor(X) + 0.5, Y, Math.Floor(Z) + 0.5);
        }

        /// <summary>
        /// The X index of the corresponding chunk in the world
        /// </summary>
        public int ChunkX
        {
            get
            {
                return (int)Math.Floor(X / Chunk.SizeX);
            }
        }

        /// <summary>
        /// The Y index of the corresponding chunk in the world
        /// </summary>
        public int ChunkY
        {
            get
            {
                return (int)Math.Floor((Y - World.GetDimension().minY) / Chunk.SizeY);
            }
        }

        /// <summary>
        /// The Z index of the corresponding chunk in the world
        /// </summary>
        public int ChunkZ
        {
            get
            {
                return (int)Math.Floor(Z / Chunk.SizeZ);
            }
        }

        /// <summary>
        /// The X index of the corresponding block in the corresponding chunk of the world
        /// </summary>
        public int ChunkBlockX
        {
            get
            {
                return ((int)Math.Floor(X) % Chunk.SizeX + Chunk.SizeX) % Chunk.SizeX;
            }
        }

        /// <summary>
        /// The Y index of the corresponding block in the corresponding chunk of the world
        /// </summary>
        public int ChunkBlockY
        {
            get
            {
                return ((int)Math.Floor(Y) % Chunk.SizeY + Chunk.SizeY) % Chunk.SizeY;
            }
        }

        /// <summary>
        /// The Z index of the corresponding block in the corresponding chunk of the world
        /// </summary>
        public int ChunkBlockZ
        {
            get
            {
                return ((int)Math.Floor(Z) % Chunk.SizeZ + Chunk.SizeZ) % Chunk.SizeZ;
            }
        }

        /// <summary>
        /// Get a squared distance to the specified location
        /// </summary>
        /// <param name="location">Other location for computing distance</param>
        /// <returns>Distance to the specified location, without using a square root</returns>
        public double DistanceSquared(Location location)
        {
            return ((X - location.X) * (X - location.X))
                 + ((Y - location.Y) * (Y - location.Y))
                 + ((Z - location.Z) * (Z - location.Z));
        }

        /// <summary>
        /// Get exact distance to the specified location
        /// </summary>
        /// <param name="location">Other location for computing distance</param>
        /// <returns>Distance to the specified location, with square root so lower performances</returns>
        public double Distance(Location location)
        {
            return Math.Sqrt(DistanceSquared(location));
        }

        /// <summary>
        /// Considering the current location as Feet location, calculate Eyes location
        /// </summary>
        /// <returns>Player Eyes location</returns>
        public Location EyesLocation()
        {
            return this + new Location(0, 1.62, 0);
        }

        /// <summary>
        /// Compare two locations. Locations are equals if the integer part of their coordinates are equals.
        /// </summary>
        /// <param name="obj">Object to compare to</param>
        /// <returns>TRUE if the locations are equals</returns>
        public override bool Equals(object? obj)
        {
            if (obj == null)
                return false;
            if (obj is Location location)
            {
                return ((int)X) == ((int)location.X)
                    && ((int)Y) == ((int)location.Y)
                    && ((int)Z) == ((int)location.Z);
            }
            return false;
        }

        /// <summary>
        /// Compare two locations. Locations are equals if the integer part of their coordinates are equals.
        /// </summary>
        /// <param name="loc1">First location to compare</param>
        /// <param name="loc2">Second location to compare</param>
        /// <returns>TRUE if the locations are equals</returns>
        public static bool operator ==(Location loc1, Location loc2)
        {
            return loc1.Equals(loc2);
        }

        /// <summary>
        /// Compare two locations. Locations are not equals if the integer part of their coordinates are not equals.
        /// </summary>
        /// <param name="loc1">First location to compare</param>
        /// <param name="loc2">Second location to compare</param>
        /// <returns>TRUE if the locations are equals</returns>
        public static bool operator !=(Location loc1, Location loc2)
        {
            return !loc1.Equals(loc2);
        }

        /// <summary>
        /// Sums two locations and returns the result.
        /// </summary>
        /// <exception cref="NullReferenceException">
        /// Thrown if one of the provided location is null
        /// </exception>
        /// <param name="loc1">First location to sum</param>
        /// <param name="loc2">Second location to sum</param>
        /// <returns>Sum of the two locations</returns>
        public static Location operator +(Location loc1, Location loc2)
        {
            return new Location
            (
                loc1.X + loc2.X,
                loc1.Y + loc2.Y,
                loc1.Z + loc2.Z
            );
        }

        /// <summary>
        /// Substract a location to another
        /// </summary>
        /// <exception cref="NullReferenceException">
        /// Thrown if one of the provided location is null
        /// </exception>
        /// <param name="loc1">First location</param>
        /// <param name="loc2">Location to substract to the first one</param>
        /// <returns>Sum of the two locations</returns>
        public static Location operator -(Location loc1, Location loc2)
        {
            return new Location
            (
                loc1.X - loc2.X,
                loc1.Y - loc2.Y,
                loc1.Z - loc2.Z
            );
        }

        /// <summary>
        /// Multiply a location by a scalar value
        /// </summary>
        /// <param name="loc">Location to multiply</param>
        /// <param name="val">Scalar value</param>
        /// <returns>Product of the location and the scalar value</returns>
        public static Location operator *(Location loc, double val)
        {
            return new Location
            (
                loc.X * val,
                loc.Y * val,
                loc.Z * val
            );
        }

        /// <summary>
        /// Divide a location by a scalar value
        /// </summary>
        /// <param name="loc">Location to divide</param>
        /// <param name="val">Scalar value</param>
        /// <returns>Result of the division</returns>
        public static Location operator /(Location loc, double val)
        {
            return new Location
            (
                loc.X / val,
                loc.Y / val,
                loc.Z / val
            );
        }

        /// <summary>
        /// DO NOT USE. Defined to comply with C# requirements requiring a GetHashCode() when overriding Equals() or ==
        /// </summary>
        /// <remarks>
        /// A modulo will be applied if the location is outside the following ranges:
        /// X: -4096 to +4095
        /// Y: -32 to +31
        /// Z: -4096 to +4095
        /// </remarks>
        /// <returns>A simplified version of the location</returns>
        public override int GetHashCode()
        {
            return (((int)X) & ~((~0) << 13)) << 19
                 | (((int)Y) & ~((~0) << 13)) << 13
                 | (((int)Z) & ~((~0) << 06)) << 00;
        }

        /// <summary>
        /// Convert the location into a string representation
        /// </summary>
        /// <returns>String representation of the location</returns>
        public override string ToString()
        {
            return String.Format("X:{0:0.00} Y:{1:0.00} Z:{2:0.00}", X, Y, Z);
        }
    }
}