From 5737e9f568754e43075817b01b6bda8ef6083e3a Mon Sep 17 00:00:00 2001
From: Jiri Vlasak <hubacji1@fel.cvut.cz>
Date: Thu, 21 Nov 2019 17:34:11 +0100
Subject: [PATCH] Add ext4 deinit

---
 api/rrtce.h    | 20 ++++++++++++++++++++
 api/rrtext.h   |  1 +
 src/rrtext4.cc |  7 +++++++
 3 files changed, 28 insertions(+)

diff --git a/api/rrtce.h b/api/rrtce.h
index a94a69e..291d566 100644
--- a/api/rrtce.h
+++ b/api/rrtce.h
@@ -21,6 +21,11 @@ class RRTCE4 : public RRTExt1, public RRTExt2, public RRTExt4 {
                         RRTExt2::init();
                         RRTExt4::init();
                 }
+                void deinit()
+                {
+                        RRTExt2::deinit();
+                        RRTExt4::deinit();
+                }
 };
 class RRTCE5 : public RRTExt2, public RRTExt5, public RRTExt4 {
         public:
@@ -29,6 +34,11 @@ class RRTCE5 : public RRTExt2, public RRTExt5, public RRTExt4 {
                         RRTExt2::init();
                         RRTExt4::init();
                 }
+                void deinit()
+                {
+                        RRTExt2::deinit();
+                        RRTExt4::deinit();
+                }
 };
 class RRTCE6 : public RRTExt2, public RRTExt6, public RRTExt4 {
         public:
@@ -37,6 +47,11 @@ class RRTCE6 : public RRTExt2, public RRTExt6, public RRTExt4 {
                         RRTExt2::init();
                         RRTExt4::init();
                 }
+                void deinit()
+                {
+                        RRTExt2::deinit();
+                        RRTExt4::deinit();
+                }
 };
 class RRTCE7
         : public RRTExt2
@@ -50,6 +65,11 @@ class RRTCE7
                         RRTExt2::init();
                         RRTExt4::init();
                 }
+                void deinit()
+                {
+                        RRTExt2::deinit();
+                        RRTExt4::deinit();
+                }
 };
 
 #endif /* RRTCE_H */
diff --git a/api/rrtext.h b/api/rrtext.h
index 5cfb866..cbefb00 100644
--- a/api/rrtext.h
+++ b/api/rrtext.h
@@ -70,6 +70,7 @@ class RRTExt4 : public virtual RRTS {
                 unsigned int yi(RRTNode n);
         public:
                 void init();
+                void deinit();
                 void store_node(RRTNode n);
                 RRTNode *nn(RRTNode &t);
                 std::vector<RRTNode *> nv(RRTNode &t);
diff --git a/src/rrtext4.cc b/src/rrtext4.cc
index e9667cc..7abfa34 100644
--- a/src/rrtext4.cc
+++ b/src/rrtext4.cc
@@ -48,6 +48,13 @@ void RRTExt4::init()
         this->y_max_ = this->nodes().back().y() + 50 * ETA;
 }
 
+void RRTExt4::deinit()
+{
+        for (unsigned int i = 0; i < 100; i++)
+                for (unsigned int j = 0; j < 100; j++)
+                        this->grid_[i][j].nodes().clear();
+}
+
 void RRTExt4::store_node(RRTNode n)
 {
         RRTS::store_node(n);
-- 
2.39.2