RGB.NET/RGB.NET.Devices.PicoPi/PicoPi/PicoPiHIDUpdateQueue.cs

using System;
using RGB.NET.Core;

namespace RGB.NET.Devices.PicoPi
{
    public class PicoPiHIDUpdateQueue : UpdateQueue
    {
        #region Constants

        private const int OFFSET_MULTIPLIER = 60;

        #endregion

        #region Properties & Fields

        private readonly PicoPiSDK _sdk;
        private readonly int _channel;

        private readonly byte[] _dataBuffer;

        #endregion

        #region Constructors

        public PicoPiHIDUpdateQueue(IDeviceUpdateTrigger updateTrigger, PicoPiSDK sdk, int channel, int ledCount)
            : base(updateTrigger)
        {
            this._sdk = sdk;
            this._channel = channel;

            _dataBuffer = new byte[ledCount * 3];
        }

        #endregion

        #region Methods

        protected override void Update(in ReadOnlySpan<(object key, Color color)> dataSet)
        {
            Span<byte> buffer = _dataBuffer;
            foreach ((object key, Color color) in dataSet)
            {
                int index = key as int? ?? -1;
                if (index < 0) continue;

                (byte _, byte r, byte g, byte b) = color.GetRGBBytes();
                int offset = index * 3;
                buffer[offset] = r;
                buffer[offset + 1] = g;
                buffer[offset + 2] = b;
            }

            int chunks = _dataBuffer.Length / OFFSET_MULTIPLIER;
            if ((chunks * OFFSET_MULTIPLIER) < buffer.Length) chunks++;
            for (int i = 0; i < chunks; i++)
            {
                int offset = i * OFFSET_MULTIPLIER;
                int length = Math.Min(buffer.Length - offset, OFFSET_MULTIPLIER);
                bool update = i == (chunks - 1);
                _sdk.SendHidUpdate(buffer.Slice(offset, length), _channel, i, update);
            }
        }

        #endregion
    }
}