void OnPositionChanged(OdometryThresholdReachedEventArgs args)
{
PositionChanged?.Invoke(this, args);
}
void OnOdometryThresholdAngleReached(OdometryThresholdReachedEventArgs args)
{
ThresholdAngleReached?.Invoke(this, args);
}
private async void Instance_ThresholdAngleReached(object sender, OdometryThresholdReachedEventArgs e)
{
Logger.GetInstance().LogLine($"Arrived at angle: {e.Data.Theta}");
Odometer.Instance.ThresholdAngleReached -= Instance_ThresholdAngleReached;
await Stop();
}
void OnOdometryThresholdPositionReached(OdometryThresholdReachedEventArgs args)
{
ThresholdPositionReached?.Invoke(this, args);
}
private async void Instance_ThresholdPositionReached(object sender, OdometryThresholdReachedEventArgs e)
{
Logger.GetInstance().LogLine($"Arrived at position waypoint: ({e.Data.X},{e.Data.Y})");
Odometer.Instance.ThresholdPositionReached -= Instance_ThresholdPositionReached;
await Stop();
}