From 108c74da3e53734616c1da00ec0760e658f45ae0 Mon Sep 17 00:00:00 2001
From: Alessio Morale <alessiomorale@gmail.com>
Date: Thu, 5 Feb 2015 15:42:58 +0100
Subject: [PATCH] OP-1704 - Reenable an hook if it is reattached

---
 flight/libraries/sanitycheck.c | 13 ++++++++++++-
 1 file changed, 12 insertions(+), 1 deletion(-)

diff --git a/flight/libraries/sanitycheck.c b/flight/libraries/sanitycheck.c
index 525fb7ccf..61950cbd9 100644
--- a/flight/libraries/sanitycheck.c
+++ b/flight/libraries/sanitycheck.c
@@ -341,7 +341,18 @@ FrameType_t GetCurrentFrameType()
 void SANITYCHECK_AttachHook(SANITYCHECK_CustomHook_function *hook)
 {
     PIOS_Assert(hook);
-    SANITYCHECK_CustomHookInstance *instance = (SANITYCHECK_CustomHookInstance *)pios_malloc(sizeof(SANITYCHECK_CustomHookInstance));
+    SANITYCHECK_CustomHookInstance *instance = NULL;
+
+    // Check whether there is an existing instance and enable it
+    LL_FOREACH(hooks, instance) {
+        if (instance->hook == hook) {
+            instance->enabled = true;
+            return;
+        }
+    }
+
+    // No existing instance found, attach this new one
+    instance = (SANITYCHECK_CustomHookInstance *)pios_malloc(sizeof(SANITYCHECK_CustomHookInstance));
     PIOS_Assert(instance);
     instance->hook    = hook;
     instance->next    = NULL;