From 5a1b94f3c7f98cac6149b898466788b864edf342 Mon Sep 17 00:00:00 2001
From: e5l <leonid.stashevsky@gmail.com>
Date: Tue, 30 Aug 2016 16:21:58 +0300
Subject: [PATCH] car_srv: fix empty size

---
 car_fmw/src/Control.kt | 9 +++++++--
 1 file changed, 7 insertions(+), 2 deletions(-)

diff --git a/car_fmw/src/Control.kt b/car_fmw/src/Control.kt
index b686b11ff8e..6189e0b639e 100644
--- a/car_fmw/src/Control.kt
+++ b/car_fmw/src/Control.kt
@@ -107,9 +107,14 @@ object Control {
             i++
         }
 
+        val distances = data.filter(::positive)
+        if (distances.size == 0) {
+            return -1
+        }
+
         return when (smoothing.id) {
-            SonarRequest.Smoothing.MEAN.id -> data.filter(::positive).mean()
-            SonarRequest.Smoothing.MEDIAN.id -> data.filter(::positive).median()
+            SonarRequest.Smoothing.MEAN.id -> distances.mean()
+            SonarRequest.Smoothing.MEDIAN.id -> distances.median()
             else -> -1
         }
     }