diff --git a/VectoCore/Models/SimulationComponent/Impl/DistanceBasedDrivingCycle.cs b/VectoCore/Models/SimulationComponent/Impl/DistanceBasedDrivingCycle.cs index fcac7469e96e71c1b43d8f0d4e2c342aec26966a..b1554fa8135906028c5d0fea7dde6ce4909e09ee 100644 --- a/VectoCore/Models/SimulationComponent/Impl/DistanceBasedDrivingCycle.cs +++ b/VectoCore/Models/SimulationComponent/Impl/DistanceBasedDrivingCycle.cs @@ -156,25 +156,25 @@ namespace TUGraz.VectoCore.Models.SimulationComponent.Impl private Radian ComputeGradient(Meter ds) { - var leftSamplePoint = CycleIntervalIterator.LeftSample; + //var leftSamplePoint = CycleIntervalIterator.LeftSample; var cycleIterator = CycleIntervalIterator.Clone(); while (cycleIterator.RightSample.Distance < PreviousState.Distance + ds && !cycleIterator.LastEntry) { cycleIterator.MoveNext(); } + var leftSamplePoint = cycleIterator.LeftSample; var rightSamplePoint = cycleIterator.RightSample; - var gradient = leftSamplePoint.RoadGradient; if (leftSamplePoint.Distance.IsEqual(rightSamplePoint.Distance)) { - return gradient; + return leftSamplePoint.RoadGradient; } CurrentState.Altitude = VectoMath.Interpolate(leftSamplePoint.Distance, rightSamplePoint.Distance, leftSamplePoint.Altitude, rightSamplePoint.Altitude, PreviousState.Distance + ds); - gradient = VectoMath.InclinationToAngle(((CurrentState.Altitude - PreviousState.Altitude) / - (ds)).Value()); + var gradient = VectoMath.InclinationToAngle(((CurrentState.Altitude - PreviousState.Altitude) / + (ds)).Value()); //return 0.SI<Radian>(); return gradient; }