tbd-station-14/Content.Client/Power/PowerMonitoringConsoleNavMapControl.cs

using Content.Client.Pinpointer.UI;
using Content.Shared.Pinpointer;
using Content.Shared.Power;
using Robust.Client.Graphics;
using Robust.Shared.Collections;
using Robust.Shared.Map.Components;
using System.Numerics;
using static Content.Shared.Power.SharedPowerMonitoringConsoleSystem;

namespace Content.Client.Power;

public sealed partial class PowerMonitoringConsoleNavMapControl : NavMapControl
{
    [Dependency] private readonly IEntityManager _entManager = default!;

    // Cable indexing
    // 0: CableType.HighVoltage
    // 1: CableType.MediumVoltage
    // 2: CableType.Apc

    private readonly Color[] _powerCableColors = { Color.OrangeRed, Color.Yellow, Color.LimeGreen };
    private readonly Vector2[] _powerCableOffsets = { new Vector2(-0.2f, -0.2f), Vector2.Zero, new Vector2(0.2f, 0.2f) };
    private Dictionary<Color, Color> _sRGBLookUp = new Dictionary<Color, Color>();

    public PowerMonitoringCableNetworksComponent? PowerMonitoringCableNetworks;
    public List<PowerMonitoringConsoleLineGroup> HiddenLineGroups = new();
    public List<PowerMonitoringConsoleLine> PowerCableNetwork = new();
    public List<PowerMonitoringConsoleLine> FocusCableNetwork = new();

    private Dictionary<Vector2i, Vector2i>[] _horizLines = [new(), new(), new()];
    private Dictionary<Vector2i, Vector2i>[] _horizLinesReversed = [new(), new(), new()];
    private Dictionary<Vector2i, Vector2i>[] _vertLines = [new(), new(), new()];
    private Dictionary<Vector2i, Vector2i>[] _vertLinesReversed = [new(), new(), new()];

    private MapGridComponent? _grid;

    public PowerMonitoringConsoleNavMapControl() : base()
    {
        // Set colors
        TileColor = new Color(30, 57, 67);
        WallColor = new Color(102, 164, 217);
        BackgroundColor = Color.FromSrgb(TileColor.WithAlpha(BackgroundOpacity));

        PostWallDrawingAction += DrawAllCableNetworks;
    }

    protected override void UpdateNavMap()
    {
        base.UpdateNavMap();

        if (Owner == null)
            return;

        if (!_entManager.TryGetComponent<PowerMonitoringCableNetworksComponent>(Owner, out var cableNetworks))
            return;

        PowerCableNetwork = GetDecodedPowerCableChunks(cableNetworks.AllChunks);
        FocusCableNetwork = GetDecodedPowerCableChunks(cableNetworks.FocusChunks);
    }

    public void DrawAllCableNetworks(DrawingHandleScreen handle)
    {
        if (!_entManager.TryGetComponent(MapUid, out _grid))
            return;

        // Draw full cable network
        if (PowerCableNetwork != null && PowerCableNetwork.Count > 0)
        {
            var modulator = (FocusCableNetwork != null && FocusCableNetwork.Count > 0) ? Color.DimGray : Color.White;
            DrawCableNetwork(handle, PowerCableNetwork, modulator);
        }

        // Draw focus network
        if (FocusCableNetwork != null && FocusCableNetwork.Count > 0)
            DrawCableNetwork(handle, FocusCableNetwork, Color.White);
    }

    public void DrawCableNetwork(DrawingHandleScreen handle, List<PowerMonitoringConsoleLine> fullCableNetwork, Color modulator)
    {
        if (!_entManager.TryGetComponent(MapUid, out _grid))
            return;

        var offset = GetOffset();
        offset = offset with { Y = -offset.Y };

        if (WorldRange / WorldMaxRange > 0.5f)
        {
            var cableNetworks = new ValueList<Vector2>[3];

            foreach (var line in fullCableNetwork)
            {
                if (HiddenLineGroups.Contains(line.Group))
                    continue;

                var cableOffset = _powerCableOffsets[(int) line.Group];
                var start = ScalePosition(line.Origin + cableOffset - offset);
                var end = ScalePosition(line.Terminus + cableOffset - offset);

                cableNetworks[(int) line.Group].Add(start);
                cableNetworks[(int) line.Group].Add(end);
            }

            for (int cableNetworkIdx = 0; cableNetworkIdx < cableNetworks.Length; cableNetworkIdx++)
            {
                var cableNetwork = cableNetworks[cableNetworkIdx];

                if (cableNetwork.Count > 0)
                {
                    var color = _powerCableColors[cableNetworkIdx] * modulator;

                    if (!_sRGBLookUp.TryGetValue(color, out var sRGB))
                    {
                        sRGB = Color.ToSrgb(color);
                        _sRGBLookUp[color] = sRGB;
                    }

                    handle.DrawPrimitives(DrawPrimitiveTopology.LineList, cableNetwork.Span, sRGB);
                }
            }
        }

        else
        {
            var cableVertexUVs = new ValueList<Vector2>[3];

            foreach (var line in fullCableNetwork)
            {
                if (HiddenLineGroups.Contains(line.Group))
                    continue;

                var cableOffset = _powerCableOffsets[(int) line.Group];

                var leftTop = ScalePosition(new Vector2
                    (Math.Min(line.Origin.X, line.Terminus.X) - 0.1f,
                    Math.Min(line.Origin.Y, line.Terminus.Y) - 0.1f)
                    + cableOffset - offset);

                var rightTop = ScalePosition(new Vector2
                    (Math.Max(line.Origin.X, line.Terminus.X) + 0.1f,
                    Math.Min(line.Origin.Y, line.Terminus.Y) - 0.1f)
                    + cableOffset - offset);

                var leftBottom = ScalePosition(new Vector2
                    (Math.Min(line.Origin.X, line.Terminus.X) - 0.1f,
                    Math.Max(line.Origin.Y, line.Terminus.Y) + 0.1f)
                    + cableOffset - offset);

                var rightBottom = ScalePosition(new Vector2
                    (Math.Max(line.Origin.X, line.Terminus.X) + 0.1f,
                    Math.Max(line.Origin.Y, line.Terminus.Y) + 0.1f)
                    + cableOffset - offset);

                cableVertexUVs[(int) line.Group].Add(leftBottom);
                cableVertexUVs[(int) line.Group].Add(leftTop);
                cableVertexUVs[(int) line.Group].Add(rightBottom);
                cableVertexUVs[(int) line.Group].Add(leftTop);
                cableVertexUVs[(int) line.Group].Add(rightBottom);
                cableVertexUVs[(int) line.Group].Add(rightTop);
            }

            for (int cableNetworkIdx = 0; cableNetworkIdx < cableVertexUVs.Length; cableNetworkIdx++)
            {
                var cableVertexUV = cableVertexUVs[cableNetworkIdx];

                if (cableVertexUV.Count > 0)
                {
                    var color = _powerCableColors[cableNetworkIdx] * modulator;

                    if (!_sRGBLookUp.TryGetValue(color, out var sRGB))
                    {
                        sRGB = Color.ToSrgb(color);
                        _sRGBLookUp[color] = sRGB;
                    }

                    handle.DrawPrimitives(DrawPrimitiveTopology.TriangleList, cableVertexUV.Span, sRGB);
                }
            }
        }
    }

    public List<PowerMonitoringConsoleLine> GetDecodedPowerCableChunks(Dictionary<Vector2i, PowerCableChunk>? chunks)
    {
        var decodedOutput = new List<PowerMonitoringConsoleLine>();

        if (!_entManager.TryGetComponent(MapUid, out _grid))
            return decodedOutput;

        if (chunks == null)
            return decodedOutput;

        Array.ForEach(_horizLines, x=> x.Clear());
        Array.ForEach(_horizLinesReversed, x=> x.Clear());
        Array.ForEach(_vertLines, x=> x.Clear());
        Array.ForEach(_vertLinesReversed, x=> x.Clear());

        foreach (var (chunkOrigin, chunk) in chunks)
        {
            for (var cableIdx = 0; cableIdx < 3; cableIdx++)
            {
                var horizLines = _horizLines[cableIdx];
                var horizLinesReversed = _horizLinesReversed[cableIdx];
                var vertLines = _vertLines[cableIdx];
                var vertLinesReversed = _vertLinesReversed[cableIdx];

                var chunkMask = chunk.PowerCableData[cableIdx];

                for (var chunkIdx = 0; chunkIdx < ChunkSize * ChunkSize; chunkIdx++)
                {
                    var value = 1 << chunkIdx;
                    var mask = chunkMask & value;

                    if (mask == 0x0)
                        continue;

                    var relativeTile = GetTileFromIndex(chunkIdx);
                    var tile = (chunk.Origin * ChunkSize + relativeTile) * _grid.TileSize;
                    tile = tile with { Y = -tile.Y };

                    PowerCableChunk neighborChunk;
                    bool neighbor;

                    // Note: we only check the north and east neighbors

                    // East
                    if (relativeTile.X == ChunkSize - 1)
                    {
                        neighbor = chunks.TryGetValue(chunkOrigin + new Vector2i(1, 0), out neighborChunk) &&
                                    (neighborChunk.PowerCableData[cableIdx] & GetFlag(new Vector2i(0, relativeTile.Y))) != 0x0;
                    }
                    else
                    {
                        var flag = GetFlag(relativeTile + new Vector2i(1, 0));
                        neighbor = (chunkMask & flag) != 0x0;
                    }

                    if (neighbor)
                    {
                        // Add points
                        AddOrUpdateNavMapLine(tile, tile + new Vector2i(_grid.TileSize, 0), horizLines, horizLinesReversed);
                    }

                    // North
                    if (relativeTile.Y == ChunkSize - 1)
                    {
                        neighbor = chunks.TryGetValue(chunkOrigin + new Vector2i(0, 1), out neighborChunk) &&
                                    (neighborChunk.PowerCableData[cableIdx] & GetFlag(new Vector2i(relativeTile.X, 0))) != 0x0;
                    }
                    else
                    {
                        var flag = GetFlag(relativeTile + new Vector2i(0, 1));
                        neighbor = (chunkMask & flag) != 0x0;
                    }

                    if (neighbor)
                    {
                        // Add points
                        AddOrUpdateNavMapLine(tile + new Vector2i(0, -_grid.TileSize), tile, vertLines, vertLinesReversed);
                    }
                }

            }
        }

        var gridOffset = new Vector2(_grid.TileSize * 0.5f, -_grid.TileSize * 0.5f);

        for (var index = 0; index < _horizLines.Length; index++)
        {
            var horizLines = _horizLines[index];
            foreach (var (origin, terminal) in horizLines)
            {
                decodedOutput.Add(new PowerMonitoringConsoleLine(origin + gridOffset, terminal + gridOffset,
                    (PowerMonitoringConsoleLineGroup) index));
            }
        }

        for (var index = 0; index < _vertLines.Length; index++)
        {
            var vertLines = _vertLines[index];
            foreach (var (origin, terminal) in vertLines)
            {
                decodedOutput.Add(new PowerMonitoringConsoleLine(origin + gridOffset, terminal + gridOffset,
                    (PowerMonitoringConsoleLineGroup) index));
            }
        }

        return decodedOutput;
    }
}

public struct PowerMonitoringConsoleLine
{
    public readonly Vector2 Origin;
    public readonly Vector2 Terminus;
    public readonly PowerMonitoringConsoleLineGroup Group;

    public PowerMonitoringConsoleLine(Vector2 origin, Vector2 terminus, PowerMonitoringConsoleLineGroup group)
    {
        Origin = origin;
        Terminus = terminus;
        Group = group;
    }
}

public enum PowerMonitoringConsoleLineGroup : byte
{
    HighVoltage,
    MediumVoltage,
    Apc,
}