From f788f062ea06571a4df333513e10ca132a4316d6 Mon Sep 17 00:00:00 2001
From: jflyper <shinoda@jaist.ac.jp>
Date: Tue, 30 Oct 2018 11:54:57 +0900
Subject: [PATCH] Reinstate rangefinder task

---
 src/main/fc/tasks.c | 16 ++++++++++++++++
 1 file changed, 16 insertions(+)

diff --git a/src/main/fc/tasks.c b/src/main/fc/tasks.c
index 19e016a377..ebfb4635ac 100644
--- a/src/main/fc/tasks.c
+++ b/src/main/fc/tasks.c
@@ -254,6 +254,13 @@ void fcTasksInit(void)
         setTaskEnabled(TASK_ATTITUDE, true);
     }
 
+
+#ifdef USE_RANGEFINDER
+    if (sensors(SENSOR_RANGEFINDER)) {
+        setTaskEnabled(TASK_RANGEFINDER, featureIsEnabled(FEATURE_RANGEFINDER));
+    }
+#endif
+
     setTaskEnabled(TASK_RX, true);
 
     setTaskEnabled(TASK_DISPATCH, dispatchIsEnabled());
@@ -597,4 +604,13 @@ cfTask_t cfTasks[TASK_COUNT] = {
         .staticPriority = TASK_PRIORITY_IDLE
     },
 #endif
+
+#ifdef USE_RANGEFINDER
+    [TASK_RANGEFINDER] = {
+        .taskName = "RANGEFINDER",
+        .taskFunc = rangefinderUpdate,
+        .desiredPeriod = TASK_PERIOD_HZ(10),
+        .staticPriority = TASK_PRIORITY_IDLE
+    },
+#endif
 };