public BaselineHeading(byte[] data)
{
_tow = BitConverter.ToUInt32(data, 0);
_heading = (double)BitConverter.ToUInt32(data, 4) / 1000.0;
_n_sats = data[8];
_fixMode = (SBP_Enums.FixMode)(data[9] & 0x7);
_raimRepair = (data[9] & 0x80) > 0;
}
public PosistionECEF(byte[] data)
{
_tow = BitConverter.ToUInt32(data, 0);
_x = BitConverter.ToDouble(data, 4);
_y = BitConverter.ToDouble(data, 12);
_z = BitConverter.ToDouble(data, 20);
_accuracy = BitConverter.ToUInt16(data, 28);
_n_sats = data[30];
_fixMode = (SBP_Enums.FixMode)(data[31] & 0x7);
_raimRepair = (data[31] & 0x80) > 0;
}
public DilutionOfPrecision(byte[] data)
{
_tow = BitConverter.ToUInt32(data, 0);
_gdop = BitConverter.ToUInt16(data, 4);
_pdop = BitConverter.ToUInt16(data, 6);
_tdop = BitConverter.ToUInt16(data, 8);
_hdop = BitConverter.ToUInt16(data, 10);
_vdop = BitConverter.ToUInt16(data, 12);
_fixMode = (SBP_Enums.FixMode)(data[14] & 0x7);
_raimRepair = (data[14] & 0x80) > 0;
}
public BaselineECEF(byte[] data)
{
_tow = BitConverter.ToUInt32(data, 0);
_x = BitConverter.ToInt32(data, 4);
_y = BitConverter.ToInt32(data, 8);
_z = BitConverter.ToInt32(data, 12);
_accuracy = BitConverter.ToUInt16(data, 16);
_n_sats = data[18];
_fixMode = (SBP_Enums.FixMode)(data[19] & 0x7);
_raimRepair = (data[19] & 0x80) > 0;
}
public BaselineNED(byte[] data)
{
_tow = BitConverter.ToUInt32(data, 0);
_n = BitConverter.ToInt32(data, 4);
_e = BitConverter.ToInt32(data, 8);
_d = BitConverter.ToInt32(data, 12);
_h_accuracy = BitConverter.ToUInt16(data, 16);
_v_accuracy = BitConverter.ToUInt16(data, 18);
_n_sats = data[20];
_fixMode = (SBP_Enums.FixMode)(data[21] & 0x7);
_raimRepair = (data[21] & 0x80) > 0;
}
public PositionLLH(byte[] data)
{
_tow = BitConverter.ToUInt32(data, 0);
_lat = BitConverter.ToDouble(data, 4);
_lon = BitConverter.ToDouble(data, 12);
_height = BitConverter.ToDouble(data, 20);
_h_accuracy = BitConverter.ToUInt16(data, 28);
_v_accuracy = BitConverter.ToUInt16(data, 30);
_heightAboveMeanSeaLevel = (data[31] & 0x4) > 0;
_n_sats = data[32];
_fixMode = (SBP_Enums.FixMode)(data[33] & 0x7);
_raimRepair = (data[33] & 0x80) > 0;
}
