From f8c69646b7e32f31a056c399e57d25fa09d6ffe3 Mon Sep 17 00:00:00 2001
From: Brian Webb <webbbn@gmail.com>
Date: Sat, 24 Sep 2016 15:10:57 -0700
Subject: [PATCH] LP-417 Blink link LED on OPLink when not connected.

---
 flight/modules/OPLink/oplinkmod.c | 8 ++------
 1 file changed, 2 insertions(+), 6 deletions(-)

diff --git a/flight/modules/OPLink/oplinkmod.c b/flight/modules/OPLink/oplinkmod.c
index 0cbbf5e7a..6727cdde3 100644
--- a/flight/modules/OPLink/oplinkmod.c
+++ b/flight/modules/OPLink/oplinkmod.c
@@ -138,11 +138,6 @@ static void systemTask(__attribute__((unused)) void *parameters)
 
     // Main system loop
     while (1) {
-        // Flash the heartbeat LED
-#if defined(PIOS_LED_HEARTBEAT)
-        PIOS_LED_Toggle(PIOS_LED_HEARTBEAT);
-#endif /* PIOS_LED_HEARTBEAT */
-
         // Update the OPLinkStatus UAVO
         OPLinkStatusData oplinkStatus;
         OPLinkStatusGet(&oplinkStatus);
@@ -192,10 +187,11 @@ static void systemTask(__attribute__((unused)) void *parameters)
             oplinkStatus.LinkState = radio_stats.link_state;
         }
 
+        // Turn on the link/heartbeat ID if we're connected, otherwise flash it.
         if (radio_stats.link_state == OPLINKSTATUS_LINKSTATE_CONNECTED) {
             LINK_LED_ON;
         } else {
-            LINK_LED_OFF;
+            LINK_LED_TOGGLE;
         }
 
         // Update the object