/// <summary>
/// Handles GPS Replace notifications from GPS service
/// </summary>
/// <param name="replace"></param>
void GPSNotificationHandler(pxGPS.Replace replace)
{
_mainPort.Post(new GPSUpdate(replace.Body));
}
/// <summary>
/// GPS Replace Notification Handler
/// </summary>
/// <param name="replace"></param>
/// <returns></returns>
IEnumerator<ITask> OnGPSReplaceHandler(pxGPS.Replace replace)
{
if (_driveControl != null)
{
WinFormsServicePort.FormInvoke(
delegate()
{
_driveControl.ReplaceGPSData(replace.Body);
}
);
}
yield break;
}
// Raul - Replace GPS Data
public void ReplaceGPSData(pxGPS.SimulatedPioneerGPSState gpsState)
{
lblGPSX.Text = String.Format("{0:n}", gpsState.X);
lblGPSY.Text = String.Format("{0:n}", gpsState.Y);
lblGPSZ.Text = String.Format("{0:n}", gpsState.Z);
lblGPSAngle.Text = String.Format("{0}", gpsState.Theta);
lblGPStime.Text = gpsState.TimeStamp.ToLongTimeString() + " " + gpsState.TimeStamp.Millisecond;
}
