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]); } 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]); } } catch { } }
private static 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("{0} {1} {2} - {3}", baseposllh[0] * Utilities.rtcm3.R2D, baseposllh[1] * Utilities.rtcm3.R2D, baseposllh[2], DateTime.Now.ToString("HH:mm:ss"))); if (!Instance.IsDisposed && Instance.but_save_basepos.Enabled == false) { Instance.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("{0} {1} {2} - {3}", baseposllh[0] * Utilities.rtcm3.R2D, baseposllh[1] * Utilities.rtcm3.R2D, baseposllh[2], DateTime.Now.ToString("HH:mm:ss"))); if (!Instance.IsDisposed && Instance.but_save_basepos.Enabled == false) { Instance.but_save_basepos.Enabled = true; } } } catch (Exception ex) { log.Error(ex); } }
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 { } }
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 { } }