Max7219.cs

// Licensed to the .NET Foundation under one or more agreements.
// The .NET Foundation licenses this file to you under the MIT license.

using System;
using System.Device.Spi;

namespace Iot.Device.Max7219
{
    /// <summary>
    /// Max7219 LED matrix driver
    /// </summary>
    public partial class Max7219 : IDisposable
    {
        private SpiDevice _spiDevice;

        /// <summary>
        /// MAX7219 Spi Clock Frequency
        /// </summary>
        public const int SpiClockFrequency = 10_000_000;

        /// <summary>
        /// MAX7219 SPI Mode
        /// </summary>
        public const SpiMode SpiMode = System.Device.Spi.SpiMode.Mode0;

        /// <summary>
        /// Number of digits Register per Module
        /// </summary>
        public const int NumDigits = 8;

        /// <summary>
        /// internal buffer used to write to registers for all devices.
        /// </summary>
        private readonly byte[] _writeBuffer;

        /// <summary>
        /// A Buffer that contains the values of the digits registers per device
        /// </summary>
        private readonly byte[,] _buffer;

        /// <summary>
        /// Number of cascaded devices
        /// </summary>
        /// <value></value>
        public int CascadedDevices { get; private set; }

        /// <summary>
        /// The Rotation to be applied (when modules are assembled rotated way)
        /// </summary>
        public RotationType Rotation { get; set; }

        /// <summary>
        /// Creates a Max7219 Device given a <see paramref="spiDevice" /> to communicate over and the
        /// number of devices that are cascaded.
        /// </summary>
        public Max7219(SpiDevice spiDevice, int cascadedDevices = 1, RotationType rotation = RotationType.None)
        {
            _spiDevice = spiDevice ?? throw new ArgumentNullException(nameof(spiDevice));
            CascadedDevices = cascadedDevices;
            Rotation = rotation;
            _buffer = new byte[CascadedDevices, NumDigits];
            _writeBuffer = new byte[2 * CascadedDevices];
        }

        /// <summary>
        /// Standard initialization routine.
        /// </summary>
        public void Init()
        {
            SetRegister(Register.SCANLIMIT, 7); // show all 8 digits
            SetRegister(Register.DECODEMODE, 0); // use matrix (not digits)
            SetRegister(Register.DISPLAYTEST, 0); // no display test
            SetRegister(Register.SHUTDOWN, 1); // not shutdown mode
            Brightness(4); // intensity, range: 0..15
            ClearAll();
        }

        /// <summary>
        /// Sends data to a specific register replicated for all cascaded devices
        /// </summary>
        internal void SetRegister(Register register, byte data)
        {
            var i = 0;
            for (byte deviceId = 0; deviceId < CascadedDevices; deviceId++)
            {
                _writeBuffer[i++] = (byte)register;
                _writeBuffer[i++] = data;
            }

            Write(_writeBuffer);
        }

        /// <summary>
        /// Write data do the spi device.
        /// </summary>
        /// <remarks>
        /// The size of the data should be 2 * cascaded devices.
        /// </remarks>
        private void Write(Span<byte> data) => _spiDevice.Write(data);

        /// <summary>
        /// Sets the brightness of all cascaded devices to the same intensity level.
        /// </summary>
        /// <param name="intensity">intensity level ranging from 0..15. </param>
        public void Brightness(int intensity)
        {
            if (intensity < 0 || intensity > 15)
            {
                throw new ArgumentOutOfRangeException(nameof(intensity),
                    $"Invalid intensity for Brightness {intensity}");
            }

            SetRegister(Register.INTENSITY, (byte)intensity);
        }

        /// <summary>
        /// Gets or Sets the value to the digit value for a given device
        /// and digit position
        /// </summary>
        public byte this[int deviceId, int digit]
        {
            get
            {
                ValidatePosition(deviceId, digit);
                return _buffer[deviceId, digit];
            }
            set
            {
                ValidatePosition(deviceId, digit);
                _buffer[deviceId, digit] = value;
            }
        }

        /// <summary>
        /// Gets or Sets the value to the digit value for a given absolute index
        /// </summary>
        public byte this[int index]
        {
            get
            {
                ValidateIndex(index, out var deviceId, out var digit);
                return _buffer[deviceId, digit];
            }
            set
            {
                ValidateIndex(index, out var deviceId, out var digit);
                _buffer[deviceId, digit] = value;
            }
        }

        /// <summary>
        /// Gets the total number of digits (cascaded devices * num digits)
        /// </summary>
        public int Length => CascadedDevices * NumDigits;

        private void ValidatePosition(int deviceId, int digit)
        {
            if (deviceId < 0 || deviceId >= CascadedDevices)
            {
                throw new ArgumentOutOfRangeException(nameof(deviceId), $"Invalid device Id: {deviceId}");
            }

            if (digit < 0 || digit >= NumDigits)
            {
                throw new ArgumentOutOfRangeException(nameof(digit), $"Invalid digit: {digit}");
            }
        }

        private void ValidateIndex(int index, out int deviceId, out int digit)
        {
            if (index < 0 || index > Length)
            {
                throw new ArgumentOutOfRangeException(nameof(index), $"Invalid index {index}");
            }

            deviceId = Math.DivRem(index, NumDigits, out digit);
        }

        /// <summary>
        /// Writes all the Values to the devices.
        /// </summary>
        public void Flush() => WriteBuffer(_buffer);

        /// <summary>
        /// Writes a two dimensional buffer containing all the values to the devices.
        /// </summary>
        public void WriteBuffer(byte[,] buffer)
        {
            switch (Rotation)
            {
                case RotationType.None:
                    WriteBufferWithoutRotation(buffer);
                    break;
                case RotationType.Half:
                    WriteBufferRotateHalf(buffer);
                    break;
                case RotationType.Right:
                    WriteBufferRotateRight(buffer);
                    break;
                case RotationType.Left:
                    WriteBufferRotateLeft(buffer);
                    break;
            }
        }

        /// <summary>
        /// Writes a two dimensional buffer containing all the values to the devices without roation
        /// </summary>
        private void WriteBufferWithoutRotation(byte[,] buffer)
        {
            ValidateBuffer(buffer);
            for (int digit = 0; digit < NumDigits; digit++)
            {
                var i = 0;
                for (var deviceId = CascadedDevices - 1; deviceId >= 0; deviceId--)
                {
                    _writeBuffer[i++] = (byte)((int)Register.DIGIT0 + digit);
                    _writeBuffer[i++] = buffer[deviceId, digit];
                }

                Write(_writeBuffer);
            }
        }

        /// <summary>
        /// Writes a two dimensional buffer containing all the values to the devices
        /// rotating values by 180 degree.
        /// </summary>
        private void WriteBufferRotateHalf(byte[,] buffer)
        {
            ValidateBuffer(buffer);
            for (int digit = 0; digit < NumDigits; digit++)
            {
                var i = 0;
                for (var deviceId = CascadedDevices - 1; deviceId >= 0; deviceId--)
                {
                    _writeBuffer[i++] = (byte)((int)Register.DIGIT0 + digit);
                    byte b = buffer[deviceId, 7 - digit];
                    // reverse bits in byte
                    b = (byte)((b * 0x0202020202 & 0x010884422010) % 1023);
                    _writeBuffer[i++] = b;

                }

                Write(_writeBuffer);
            }
        }

        /// <summary>
        /// Writes a two dimensional buffer containing all the values to the devices
        /// rotating values to the right.
        /// </summary>
        private void WriteBufferRotateRight(byte[,] buffer)
        {
            ValidateBuffer(buffer);
            for (int digit = 0; digit < NumDigits; digit++)
            {
                var mask = 0x01 << digit;
                var i = 0;
                for (var deviceId = CascadedDevices - 1; deviceId >= 0; deviceId--)
                {
                    _writeBuffer[i++] = (byte)((int)Register.DIGIT0 + digit);
                    byte value = 0;
                    byte targetBit = 0x80;
                    for (int bitDigit = 0; bitDigit < NumDigits; bitDigit++, targetBit >>= 1)
                    {
                        if ((buffer[deviceId, bitDigit] & mask) != 0)
                        {
                            value |= targetBit;
                        }
                    }

                    _writeBuffer[i++] = value;
                }

                Write(_writeBuffer);
            }
        }

        /// <summary>
        /// Writes a two dimensional buffer containing all the values to the devices
        /// rotating values to the left.
        /// </summary>
        private void WriteBufferRotateLeft(byte[,] buffer)
        {
            ValidateBuffer(buffer);
            for (int digit = 0; digit < NumDigits; digit++)
            {
                var mask = 0x80 >> digit;
                var i = 0;
                for (var deviceId = CascadedDevices - 1; deviceId >= 0; deviceId--)
                {
                    _writeBuffer[i++] = (byte)((int)Register.DIGIT0 + digit);
                    byte value = 0;
                    byte targetBit = 0x01;
                    for (int bitDigit = 0; bitDigit < NumDigits; bitDigit++, targetBit <<= 1)
                    {
                        if ((buffer[deviceId, bitDigit] & mask) != 0)
                        {
                            value |= targetBit;
                        }
                    }

                    _writeBuffer[i++] = value;
                }

                Write(_writeBuffer);
            }
        }

        /// <summary>
        /// Validates the buffer dimensions.
        /// </summary>
        /// <param name="buffer">Buffer to validate</param>
        private void ValidateBuffer(byte[,] buffer)
        {
            if (buffer.Rank != 2)
            {
                throw new ArgumentException($"buffer must be two dimensional.", nameof(buffer));
            }

            if (buffer.GetUpperBound(0) != CascadedDevices - 1)
            {
                throw new ArgumentException($"buffer upper bound ({buffer.GetUpperBound(0)}) for dimension 0 must be {CascadedDevices - 1}.", nameof(buffer));
            }

            if (buffer.GetUpperBound(1) != NumDigits - 1)
            {
                throw new ArgumentException($"buffer upper bound ({buffer.GetUpperBound(1)}) for dimension 1 must be {NumDigits - 1}.", nameof(buffer));
            }
        }

        /// <summary>
        /// Clears the buffer from the given start to end (exclusive) and flushes
        /// </summary>
        public void Clear(int start, int end, bool flush = true)
        {
            if (end < 0 || end > CascadedDevices)
            {
                throw new ArgumentOutOfRangeException(nameof(end));
            }

            if (start < 0 || start >= end)
            {
                throw new ArgumentOutOfRangeException(nameof(end));
            }

            for (int deviceId = start; deviceId < end; deviceId++)
            {
                for (int digit = 0; digit < NumDigits; digit++)
                {
                    this[deviceId, digit] = 0;
                }
            }

            if (flush)
            {
                Flush();
            }
        }

        /// <summary>
        /// Clears the buffer from the given start to end and flushes
        /// </summary>
        public void ClearAll(bool flush = true) => Clear(0, CascadedDevices, flush);

        /// <inheritdoc/>
        public void Dispose()
        {
            _spiDevice?.Dispose();
            _spiDevice = null!;
        }
    }
}