NetServer.Disconnect added; Buffer.BlockCopy used in NetBitWriter

Lidgren.Network/NetBitWriter.cs

@@ -72,8 +72,7 @@ namespace Lidgren.Network
 
 			if (startReadAtIndex == 0)
 			{
-				for (int i = 0; i < numberOfBytes; i++)
+				Buffer.BlockCopy(fromBuffer, readPtr, destination, destinationByteOffset, numberOfBytes);
-					destination[destinationByteOffset++] = fromBuffer[readPtr++];
 				return;
 			}
 
@@ -146,9 +145,7 @@ namespace Lidgren.Network
 
 			if (firstPartLen == 0)
 			{
-				// optimized; TODO: write 32 bit chunks if possible
+				Buffer.BlockCopy(source, sourceByteOffset, destination, dstBytePtr, numberOfBytes);
-				for (int i = 0; i < numberOfBytes; i++)
-					destination[dstBytePtr++] = source[sourceByteOffset + i];
 				return;
 			}
 

Lidgren.Network/NetServer.cs

@@ -29,5 +29,10 @@ namespace Lidgren.Network
 			// force this to true
 			config.AcceptIncomingConnections = true;
 		}
+
+		public void Disconnect(NetConnection connection, string byeMessage)
+		{
+			connection.Disconnect(byeMessage);
+		}
 	}
 }

UnitTests/ReadWriteTests.cs

@@ -107,6 +107,18 @@ namespace UnitTests
 			bool one = rdr.ReadBoolean();
 			string hallon = rdr.ReadString();
 			byte fourtyTwo = rdr.ReadByte();
+
+			// test aligned WriteBytes/ReadBytes
+			msg = peer.CreateMessage();
+			byte[] tmparr = new byte[] { 5, 6, 7, 8, 9 };
+			msg.Write(tmparr);
+
+			inc = Program.CreateIncomingMessage(msg.PeekDataBuffer(), msg.LengthBits);
+			byte[] result = inc.ReadBytes(tmparr.Length);
+
+			for (int i = 0; i < tmparr.Length; i++)
+				if (tmparr[i] != result[i])
+					throw new Exception("readbytes fail");
 		}
 	}