private void ExtractBasePos(int seen)
{
try
{
if (seen == 1005)
{
var basepos = new Utilities.rtcm3.type1005();
basepos.Read(rtcm3.packet);
var pos = basepos.ecefposition;
double[] baseposllh = new double[3];
Utilities.rtcm3.ecef2pos(pos, ref baseposllh);
MainV2.comPort.MAV.cs.MovingBase = new Utilities.PointLatLngAlt(baseposllh[0]*Utilities.rtcm3.R2D,
baseposllh[1]*Utilities.rtcm3.R2D, baseposllh[2]);
status_line3 =
(String.Format("RTCM Base {0} {1} {2}", baseposllh[0]*Utilities.rtcm3.R2D,
baseposllh[1]*Utilities.rtcm3.R2D, baseposllh[2]));
if (!Instance.IsDisposed && but_save_basepos.Enabled == false)
but_save_basepos.Enabled = true;
}
else if (seen == 1006)
{
var basepos = new Utilities.rtcm3.type1006();
basepos.Read(rtcm3.packet);
var pos = basepos.ecefposition;
double[] baseposllh = new double[3];
Utilities.rtcm3.ecef2pos(pos, ref baseposllh);
MainV2.comPort.MAV.cs.MovingBase = new Utilities.PointLatLngAlt(baseposllh[0], baseposllh[1],
baseposllh[2]);
status_line3 =
(String.Format("RTCM Base {0} {1} {2}", baseposllh[0]*Utilities.rtcm3.R2D,
baseposllh[1]*Utilities.rtcm3.R2D, baseposllh[2]));
if (!Instance.IsDisposed && but_save_basepos.Enabled == false)
but_save_basepos.Enabled = true;
}
}
catch
{
}
}