Sample speed test for Transport Stream construction

using System;

namespace mpeg_tst
{
	public class PES
	{
		private byte[]	Packet_Start_Code_Prefix;	// 3 bytes
		private byte	Stream_ID;					// 1 byte
		private	byte[]	PES_Packet_Length;			// 2 bytes
		private byte[]	PES_Header_Flags;			// 2 bytes = "10"(2 biti) + PES_H_F(14 biti)
		private	byte	PES_Header_Length;			// 1 byte
		private	byte[]	PES_Header_Fields;			// Variable length
		private	byte[]	PES_Packet_Data;			// Variable length

		public byte[]	PES_output;		// Pachetul final asamblat
		public int data_len;				// Lungimea segmentului de date

		public PES() // Constructorul implicit
		{	
			Packet_Start_Code_Prefix=new byte[3];
			PES_Packet_Length=new byte[2];
			PES_Header_Flags=new byte[2];
		}

		public PES(int h_length) // Constructor cu marimea headerului
		{
			Packet_Start_Code_Prefix=new byte[3];
			PES_Packet_Length=new byte[2];
			PES_Header_Flags=new byte[2];			
			PES_Header_Fields=new byte[h_length];
			PES_Header_Length=Convert.ToByte(h_length);
		}

		public PES(int h_length,int p_length) // Constructor cu marimea headerului si a pachetului
		{
			Packet_Start_Code_Prefix=new byte[3];
			PES_Packet_Length=new byte[2];
			PES_Header_Flags=new byte[2];			
			PES_Header_Fields=new byte[h_length];
			data_len=p_length-3-h_length;
			PES_Packet_Data=new byte[data_len];
			PES_output=new byte[6+p_length];
			PES_Header_Length=Convert.ToByte(h_length);
			set_Packet_Length(p_length);
		}


		public void set_Packet_Length(int len) // Seteaza lungimea PES_Packet_Length
		{
			PES_Packet_Length[0]=Convert.ToByte(len%256);
			PES_Packet_Length[1]=Convert.ToByte(Convert.ToInt16(len/256));
		}

		public int get_Packet_Length() // Afla lungimea PES_Packet_Length
		{	return PES_Packet_Length[1]*256+PES_Packet_Length[0];}


		public void set_antet() // Setare a antetului cu valori de "marcare"
		{
			Packet_Start_Code_Prefix[0]=35;// "#"
			Packet_Start_Code_Prefix[1]=35;
			Packet_Start_Code_Prefix[2]=35;
			Stream_ID=36; // "$"
			PES_Header_Flags[0]=36;
			PES_Header_Flags[1]=36;
			for(int i=0;i<PES_Header_Length;i++) PES_Header_Fields[i]=36;
		}

		public void set_Packet_Data(byte[] raw_data)
		{
				int i,len;
			len=raw_data.GetLength(0);
			for(i=0;i<len;i++) PES_Packet_Data[i]=raw_data[i];
			if(len<data_len) for(i=len;i<data_len;i++) PES_Packet_Data[i]=38; // '&' stuffing
		}


		public void asemby_output()
		{int i;
			set_antet();
			PES_output[0]=Packet_Start_Code_Prefix[0];
			PES_output[1]=Packet_Start_Code_Prefix[1];
			PES_output[2]=Packet_Start_Code_Prefix[2];
			PES_output[3]=Stream_ID;
			PES_output[4]=PES_Packet_Length[0];
			PES_output[5]=PES_Packet_Length[1];
			PES_output[6]=PES_Header_Flags[0];
			PES_output[7]=PES_Header_Flags[1];
			PES_output[8]=PES_Header_Length;
			for(i=0;i<PES_Header_Length;i++) PES_output[9+i]=PES_Header_Fields[i];
			for(i=0;i<get_Packet_Length()-3-PES_Header_Length;i++)
					PES_output[9+PES_Header_Length+i]=PES_Packet_Data[i];
		}
	}
}