public void AddTxPack2TXQueue(SerialParameterPacketHeader txHeaderIn, List <byte> SerialDataOut_in)
 {
     if (StaticSPDPackets.Count > 0)
     {
         SerialParameterPacket tempPacket = StaticSPDPackets.Find(x => x.PackID == txHeaderIn.PacketID);
         if (tempPacket != null)
         {
             AddTxPack2TXQueueNoStatic(txHeaderIn, SerialDataOut_in);
         }
     }
 }
        public void AddTxPack2TXQueueNoStatic(SerialParameterPacketHeader txHeaderIn, List <byte> SerialDataOut_in)
        {
            List <byte> tempBuffer = new List <byte>();

            tempBuffer.AddRange(txHeaderIn.HDR2ByteArray());
            if (SerialDataOut_in != null)
            {
                if (SerialDataOut_in.Count > 0)
                {
                    tempBuffer.AddRange(SerialDataOut_in);
                }
            }

            TxPacketQueue.Add(tempBuffer.ToArray());
        }