From e576edc6bba53076e1196008b78c78223817efe1 Mon Sep 17 00:00:00 2001
From: Markus Quaritsch <markus.quaritsch@tugraz.at>
Date: Wed, 26 Apr 2017 14:53:24 +0200
Subject: [PATCH] 1hz filter: handle the case if vehicle already stopped but
there is some time left for the whole second
---
.../VectoCore/OutputData/ModFilter/ModalData1HzFilter.cs | 4 ++++
1 file changed, 4 insertions(+)
diff --git a/VectoCore/VectoCore/OutputData/ModFilter/ModalData1HzFilter.cs b/VectoCore/VectoCore/OutputData/ModFilter/ModalData1HzFilter.cs
index 929f9b2e11..aaf1c8c3e2 100644
--- a/VectoCore/VectoCore/OutputData/ModFilter/ModalData1HzFilter.cs
+++ b/VectoCore/VectoCore/OutputData/ModFilter/ModalData1HzFilter.cs
@@ -157,6 +157,10 @@ namespace TUGraz.VectoCore.OutputData.ModFilter
var dt = remainingDt;
var a = (MeterPerSquareSecond)last[(int)ModalResultField.acc];
var ds = v * dt + a / 2 * dt * dt;
+ if (v.IsEqual(0)) {
+ ds = 0.SI<Meter>();
+ a = 0.SI<MeterPerSquareSecond>();
+ }
if (ds.IsSmaller(0)) {
throw new VectoSimulationException("1Hz-Filter: simulation distance must not be negative. ds: {0} {1}", ds, "4");
}
--
GitLab