public int Read(byte data)
{
switch (step)
{
default:
case 0:
if (data == RTCM3PREAMB)
{
step = 1;
buffer[0] = data;
}
break;
case 1:
buffer[1] = data;
step++;
break;
case 2:
buffer[2] = data;
step++;
pre = new rtcmpreamble();
pre.Read(buffer);
payloadlen = pre.length;
msglencount = 0;
// reset on oversize packet
if (payloadlen > buffer.Length)
step = 0;
break;
case 3:
if (msglencount < (payloadlen))
{
buffer[msglencount + 3] = data;
msglencount++;
}
else
{
step++;
goto case 4;
}
break;
case 4:
buffer[payloadlen + 3] = data;
step++;
break;
case 5:
buffer[payloadlen + 3 + 1] = data;
step++;
break;
case 6:
buffer[payloadlen + 3 + 2] = data;
payloadlen = payloadlen + 3;
u32 crc = crc24.crc24q(buffer, payloadlen, 0);
u32 crcpacket = getbitu(buffer, payloadlen * 8, 24);
if (crc == crcpacket)
{
rtcmheader head = new rtcmheader();
head.Read(buffer);
step = 0;
return head.messageno;
}
step = 0;
break;
}
return -1;
}
public int Read(byte data)
{
switch (step)
{
default:
case 0:
if (data == RTCM3PREAMB)
{
step = 1;
buffer[0] = data;
}
break;
case 1:
buffer[1] = data;
step++;
break;
case 2:
buffer[2] = data;
step++;
pre = new rtcmpreamble();
pre.Read(buffer);
payloadlen = pre.length;
msglencount = 0;
// reset on oversize packet
if (payloadlen > buffer.Length)
{
step = 0;
}
break;
case 3:
if (msglencount < (payloadlen))
{
buffer[msglencount + 3] = data;
msglencount++;
}
else
{
step++;
goto case 4;
}
break;
case 4:
buffer[payloadlen + 3] = data;
step++;
break;
case 5:
buffer[payloadlen + 3 + 1] = data;
step++;
break;
case 6:
buffer[payloadlen + 3 + 2] = data;
payloadlen = payloadlen + 3;
u32 crc = crc24.crc24q(buffer, payloadlen, 0);
u32 crcpacket = getbitu(buffer, payloadlen * 8, 24);
if (crc == crcpacket)
{
rtcmheader head = new rtcmheader();
head.Read(buffer);
step = 0;
return(head.messageno);
}
step = 0;
break;
}
return(-1);
}
public void Read(byte data)
{
switch (step)
{
case 0:
if (data == RTCM3PREAMB)
{
step++;
packet[0] = data;
}
break;
case 1:
packet[1] = data;
step++;
break;
case 2:
packet[2] = data;
step++;
pre = new rtcmpreamble();
pre.Read(packet);
len = pre.length;
a = 0;
// reset on oversize packet
if (len > packet.Length)
step = 0;
break;
case 3:
if (a < (len))
{
packet[a + 3] = data;
a++;
}
else
{
step++;
goto case 4;
}
break;
case 4:
packet[len + 3] = data;
step++;
break;
case 5:
packet[len + 3 + 1] = data;
step++;
break;
case 6:
packet[len + 3 + 2] = data;
len = len + 3;
u32 crc = crc24q(packet, len, 0);
u32 crcpacket = getbitu(packet, len * 8, 24);
//Console.WriteLine(crc.ToString("X") + " " + crcpacket.ToString("X"));
if (crc == crcpacket)
{
rtcmheader head = new rtcmheader();
head.Read(packet);
if (head.messageno == 1002)
{
type1002 tp = new type1002();
tp.Read(packet);
/*
byte[] test = new byte[300];
pre.Write(test);
head.Write(test);
tp.Write(test);
uint rem = tp.nbits % 8;
uint len2 = (tp.nbits + rem) / 8;
uint crc2 = crc24q(test, len, 0);
setbitu(test, tp.nbits + rem, 24, crc2);
*/
if (ObsMessage != null)
ObsMessage(tp.obs, null);
}
if (head.messageno == 1004)
{
type1004 tp = new type1004();
tp.Read(packet);
if (ObsMessage != null)
ObsMessage(tp.obs, null);
}
if (head.messageno == 1005)
{
type1005 tp = new type1005();
tp.Read(packet);
if (BasePosMessage != null)
BasePosMessage(tp, null);
}
if (head.messageno == 1006)
{
type1006 tp = new type1006();
tp.Read(packet);
if (BasePosMessage != null)
BasePosMessage(tp, null);
}
if (head.messageno == 1019)
{
type1019 tp = new type1019();
tp.Read(packet);
if (EphMessage != null)
EphMessage(tp, null);
}
}
step = 0;
break;
}
}
public int Read(byte data)
{
switch (step)
{
default:
case 0:
if (data == RTCM3PREAMB)
{
step = 1;
packet[0] = data;
}
break;
case 1:
packet[1] = data;
step++;
break;
case 2:
packet[2] = data;
step++;
pre = new rtcmpreamble();
pre.Read(packet);
len = pre.length;
a = 0;
// reset on oversize packet
if (len > packet.Length)
step = 0;
break;
case 3:
if (a < (len))
{
packet[a + 3] = data;
a++;
}
else
{
step++;
goto case 4;
}
break;
case 4:
packet[len + 3] = data;
step++;
break;
case 5:
packet[len + 3 + 1] = data;
step++;
break;
case 6:
packet[len + 3 + 2] = data;
len = len + 3;
u32 crc = crc24.crc24q(packet, len, 0);
u32 crcpacket = getbitu(packet, len * 8, 24);
if (crc == crcpacket)
{
rtcmheader head = new rtcmheader();
head.Read(packet);
step = 0;
return head.messageno;
}
step = 0;
break;
}
return -1;
}
public int Read(byte data)
{
switch (step)
{
default:
case 0:
if (data == RTCM3PREAMB)
{
step = 1;
packet[0] = data;
}
break;
case 1:
packet[1] = data;
step++;
break;
case 2:
packet[2] = data;
step++;
pre = new rtcmpreamble();
pre.Read(packet);
len = pre.length;
a = 0;
// reset on oversize packet
if (len > packet.Length)
{
step = 0;
}
break;
case 3:
if (a < (len))
{
packet[a + 3] = data;
a++;
}
else
{
step++;
goto case 4;
}
break;
case 4:
packet[len + 3] = data;
step++;
break;
case 5:
packet[len + 3 + 1] = data;
step++;
break;
case 6:
packet[len + 3 + 2] = data;
len = len + 3;
u32 crc = crc24.crc24q(packet, len, 0);
u32 crcpacket = getbitu(packet, len * 8, 24);
if (crc == crcpacket)
{
rtcmheader head = new rtcmheader();
head.Read(packet);
step = 0;
return(head.messageno);
}
step = 0;
break;
}
return(-1);
}
public void Read(byte data)
{
switch (step)
{
case 0:
if (data == RTCM3PREAMB)
{
step++;
packet[0] = data;
}
break;
case 1:
packet[1] = data;
step++;
break;
case 2:
packet[2] = data;
step++;
pre = new rtcmpreamble();
pre.Read(packet);
len = pre.length;
a = 0;
// reset on oversize packet
if (len > packet.Length)
{
step = 0;
}
break;
case 3:
if (a < (len))
{
packet[a + 3] = data;
a++;
}
else
{
step++;
goto case 4;
}
break;
case 4:
packet[len + 3] = data;
step++;
break;
case 5:
packet[len + 3 + 1] = data;
step++;
break;
case 6:
packet[len + 3 + 2] = data;
len = len + 3;
u32 crc = crc24q(packet, len, 0);
u32 crcpacket = getbitu(packet, len * 8, 24);
//Console.WriteLine(crc.ToString("X") + " " + crcpacket.ToString("X"));
if (crc == crcpacket)
{
rtcmheader head = new rtcmheader();
head.Read(packet);
if (head.messageno == 1002)
{
type1002 tp = new type1002();
tp.Read(packet);
/*
* byte[] test = new byte[300];
*
* pre.Write(test);
* head.Write(test);
* tp.Write(test);
*
* uint rem = tp.nbits % 8;
* uint len2 = (tp.nbits + rem) / 8;
*
* uint crc2 = crc24q(test, len, 0);
* setbitu(test, tp.nbits + rem, 24, crc2);
*/
if (ObsMessage != null)
{
ObsMessage(tp.obs, null);
}
}
if (head.messageno == 1004)
{
type1004 tp = new type1004();
tp.Read(packet);
if (ObsMessage != null)
{
ObsMessage(tp.obs, null);
}
}
if (head.messageno == 1005)
{
type1005 tp = new type1005();
tp.Read(packet);
if (BasePosMessage != null)
{
BasePosMessage(tp, null);
}
}
if (head.messageno == 1006)
{
type1006 tp = new type1006();
tp.Read(packet);
if (BasePosMessage != null)
{
BasePosMessage(tp, null);
}
}
if (head.messageno == 1019)
{
type1019 tp = new type1019();
tp.Read(packet);
if (EphMessage != null)
{
EphMessage(tp, null);
}
}
}
step = 0;
break;
}
}