public override void PacketHandler(N2HBinaryReader reader)
{
var marker = reader.ReadByte();
if (marker != 0x0b)
{
Logger.FATAL("Marker hand shake wrong:should be 0b and not {0}", marker);
return;
}
var time = reader.ReadUInt16();
var id = reader.ReadByte();
var length = reader.ReadUInt16();
reader.Shrink(length);
var pos = Writer.BaseStream.Position;
Writer.BaseStream.Position += 3;
var idResponse = PerformHandshake(id, reader, pos);
if (idResponse > 0)
{
Writer.BaseStream.Position = pos;
Writer.Write(idResponse);
Writer.Write((short)(Writer.BaseStream.GetAvaliableByteCounts() - 2));
Flush(0x0b);
}
FarId = 0;
}
public static bool Deserialize(Stream src, out VideoAvc dest)
{
dest = new VideoAvc();
if (src.GetAvaliableByteCounts() < 2)
{
Logger.FATAL("Not enough data");
return(false);
}
var reader = new N2HBinaryReader(src);
var _spsLength = reader.ReadUInt16();
if (src.GetAvaliableByteCounts() < _spsLength + 2 + 8)
{
Logger.FATAL("Not enough data");
return(false);
}
var psps = reader.ReadBytes(_spsLength);
var _ppsLength = reader.ReadUInt16();
if (src.GetAvaliableByteCounts() < _ppsLength + 2 + 8)
{
Logger.FATAL("Not enough data");
return(false);
}
var ppps = reader.ReadBytes(_ppsLength);
dest.Init(psps, ppps);
dest._widthOverride = reader.ReadUInt32();
dest._heightOverride = reader.ReadUInt32();
return(true);
}
public override bool FeedData(Stream pData, uint dataLength, uint processedLength, uint totalLength, uint absoluteTimestamp,
bool isAudio)
{
var pos = pData.Position;
var firstByte = pData.ReadByte();
var secondByte = pData.ReadByte();
pData.Position = pos;
if (isAudio)
{
if ((firstByte >> 4) == 10 && secondByte == 0)
{
pData.CopyDataTo(AudioCodecBuffer);
AudioCodecBuffer.Position = 0;
if (!Capabilities.InitAudioAAC(AudioCodecBuffer, (int)(AudioCodecBuffer.Length - 2)))
{
Logger.FATAL("InitAudioAAC failed");
return(false);
}
AudioCodecBuffer.Position = 0;
}
_lastAudioTime = absoluteTimestamp;
}
else
{
if (firstByte == 0x17 && secondByte == 0)
{
pData.CopyDataTo(VideoCodecBuffer);
VideoCodecBuffer.Position = 0;
var reader = new N2HBinaryReader(VideoCodecBuffer);
var spsLength = reader.ReadUInt16();
var pSPS = reader.ReadBytes(spsLength);
reader.ReadByte();
var ppsLength = reader.ReadUInt16();
var pPPS = reader.ReadBytes(ppsLength);
if (!Capabilities.InitVideoH264(pSPS, pPPS))
{
Logger.FATAL("InitVideoH264 failed");
return(false);
}
VideoCodecBuffer.Position = 0;
}
_lastVideoTime = absoluteTimestamp;
}
//var temp = OutStreams.Where(x => !x.IsEnqueueForDelete() && !x.FeedData(pData, dataLength, processedLength, totalLength, absoluteTimestamp, isAudio));
//foreach (var baseOutNetRtmpStream in temp)
//{
// this.Log().Info("Unable to feed OS:" + baseOutNetRtmpStream);
// baseOutNetRtmpStream.EnqueueForDelete();
// if (Protocol == baseOutNetRtmpStream.GetProtocol()) return false;
//}
base.FeedData(pData, dataLength, processedLength, totalLength, absoluteTimestamp, isAudio);
return(true);
}
public static bool ReadCRC(N2HBinaryReader packet)
{
// Check the first 2 CRC bytes
packet.BaseStream.Position = 4;
UInt16 sum = packet.ReadUInt16();
return(sum == CheckSum(packet.BaseStream));
}
public virtual void PacketHandler(N2HBinaryReader reader)
{
if (IsEnqueueForDelete)
{
return;
}
RecTimestamp.Restart();
var marker = reader.ReadByte() | 0xF0;
TimeSent = reader.ReadUInt16();
if (marker == (Target == null?0xFD:0xFE))
{
var time = RtmfpUtils.TimeNow();
var timeEcho = reader.ReadUInt16();
if (timeEcho > time)
{
if (timeEcho - time < 30)
{
time = 0;
}
else
{
time += (ushort)(0xFFFF - timeEcho);
}
timeEcho = 0;
}
Peer.Ping = (ushort)((time - timeEcho) * Defines.RTMFP_TIMESTAMP_SCALE);
}
else if (marker != (Target == null ? 0xF9 : 0xFA))
{
Logger.WARN("Packet marker unknown:{0}", marker);
return;
}
byte flags = 0;
Flow flow = null;
ulong stage = 0;
ulong deltaNAck = 0;
var type = reader.BaseStream.GetAvaliableByteCounts() > 0 ? reader.ReadByte() : (byte)0xFF;
//Debug.WriteLine("rec:{0:x}",type);
while (type != 0xFF)
{
var size = reader.ReadUInt16();
long nextPos = reader.BaseStream.Position + size;
var oldPublished = (reader.BaseStream as InputStream).Published;
(reader.BaseStream as InputStream).Published = (uint)nextPos;
switch (type)
{
case 0x0c:
Fail("failed on client side");
break;
case 0x4c:
_failed = true;
EnqueueForDelete();
return;
case 0x01:
if (!Peer.Connected)
{
Fail("Timeout connection client");
}
else
{
WriteMessage(0x41, 0);
}
goto case 0x41;
case 0x41:
Logger.INFO("keepAlive!");
_timesKeepalive = 0;
break;
case 0x5e:
var idFlow = reader.Read7BitLongValue();
if (!FlowWriters.ContainsKey(idFlow))
{
Logger.WARN("FlowWriter {0} unfound for acknowledgment on session {1}", idFlow, Id);
}
else
{
var flowWriter = FlowWriters[idFlow];
flowWriter.Fail("flowWriter rejected on session " + Id);
}
break;
case 0x18:
Fail("ack negative from server");
break;
case 0x51:
//Acknowledgment
idFlow = reader.Read7BitLongValue();
if (FlowWriters.ContainsKey(idFlow))
{
FlowWriters[idFlow].Acknowledgment(reader);
}
else
{
Logger.WARN("FlowWriter {0} unfound for acknowledgment on session {1}", idFlow, Id);
}
break;
case 0x10:
flags = reader.ReadByte();
idFlow = reader.Read7BitLongValue();
stage = reader.Read7BitLongValue() - 1;
deltaNAck = reader.Read7BitLongValue() - 1;
//Debug.WriteLine("10:{0},{1},{2}",idFlow,stage,deltaNAck);
if (_failed)
{
break;
}
if (Flows.ContainsKey(idFlow))
{
flow = Flows[idFlow];
}
if ((flags & FlowWriter.MESSAGE_HEADER) != 0)
{
var signature = reader.ReadString8();
ulong assocFlowId = 0;
if (reader.ReadByte() > 0)
{
if (reader.ReadByte() != 0x0A)
{
Logger.WARN("Unknown fullduplex header part for the flow {0}", idFlow);
}
else
{
assocFlowId = reader.Read7BitLongValue();
}
var length = reader.ReadByte();
while (length > 0 && reader.BaseStream.GetAvaliableByteCounts() > 0)
{
Logger.WARN("Unknown message part on flow {0}", idFlow);
reader.BaseStream.Position += length;
length = reader.ReadByte();
}
if (length > 0)
{
Logger.FATAL("Bad header message part, finished before scheduled");
}
}
if (flow == null)
{
flow = CreateFlow(idFlow, signature, assocFlowId);
}
}
if (flow == null)
{
}
goto case 0x11;
case 0x11:
++stage;
++deltaNAck;
if (type == 0x11)
{
flags = reader.ReadByte();
}
if (flow != null)
{
flow.FragmentHandler(stage, deltaNAck, reader.BaseStream, flags);
if (!string.IsNullOrEmpty(flow.Error))
{
Fail(flow.Error);
flow = null;
}
}
break;
default:
Logger.FATAL("Message type {0} unknown", type);
break;
}
reader.BaseStream.Position = nextPos;
(reader.BaseStream as InputStream).Published = oldPublished;
type = (byte)(reader.BaseStream.GetAvaliableByteCounts() > 0 ? reader.ReadByte() : 0xFF);
if (flow != null && type != 0x11)
{
flow.Commit();
if (flow.Completed)
{
Flows.Remove(flow.Id);
flow.Dispose();
}
flow = null;
}
//else
//{
// Debug.WriteLine("no commit:{0},{1:X}",flow?.Id.ToString() ?? "no flow",type);
//}
}
SFlush(true);
}
public override void PacketHandler(N2HBinaryReader reader)
{
if (Checked)
{
lock (Writer)
{
base.PacketHandler(reader);
}
return;
}
var marker = reader.ReadByte();
if (marker != 0x0b)
{
Logger.FATAL("Marker hand shake wrong:should be 0b and not {0:X}", marker);
return;
}
var time = reader.ReadUInt16();
var type = reader.ReadByte();
var length = reader.ReadUInt16();
byte[] tag;
Logger.Debug("handshake {0:X} len:{1}", type, length);
Debug.WriteLine("handshake {0:X} len:{1}", type, length);
switch (type)
{
case 0x70:
tag = reader.ReadBytes(reader.ReadByte());
var cookieBytes = reader.ReadBytes(reader.ReadByte());
var targetCertificat = reader.ReadBytes((int)reader.BaseStream.GetAvaliableByteCounts());
var nonce = new byte[0];
_dh = RtmfpUtils.BeginDiffieHellman(ref nonce, true);
Peer.Id = Target.Sha256.ComputeHash(nonce, 0, nonce.Length);
HandShake38(cookieBytes, nonce);
_handshake = () => HandShake38(cookieBytes, nonce);
break;
case 0x71:
tag = reader.ReadBytes(reader.ReadByte());
var flag = reader.ReadByte();
var address = new IPEndPoint(new IPAddress(reader.ReadBytes(4)), reader.ReadInt16());
Target.Address.Port = address.Port;
Logger.Debug("redirect to {0}", address.ToString());
Handler.FarProtocol.IOHandler.Socket.Connect(Target.Address);
_handshake();
break;
case 0x78:
FarId = reader.ReadUInt32();
var targetNonce = reader.ReadBytes((int)reader.Read7BitLongValue());
var must58 = reader.ReadByte();
Debug.WriteLineIf(must58 != 0x58, $"must58!{must58}");
var key = new byte[RtmfpUtils.KEY_SIZE];
Buffer.BlockCopy(targetNonce, targetNonce.Length - RtmfpUtils.KEY_SIZE, key, 0, RtmfpUtils.KEY_SIZE);
var sharedSecret = _dh.CreateSharedKey(key);
byte[] decryptKey;
byte[] encryptKey;
RtmfpUtils.ComputeAsymetricKeys(sharedSecret, _certificat, targetNonce, out encryptKey, out decryptKey);
Checked = true;
_handshakeTimeoutTimer.Stop();
AesEncrypt = new AESEngine(encryptKey, AESEngine.Direction.ENCRYPT);
AesDecrypt = new AESEngine(decryptKey);
PrevAesType = AESEngine.AESType.DEFAULT;
Application = Handler.Application;
Handler.CreateSession(Peer, null);
break;
default:
break;
}
}
