From f8de362c43abddb7369c343d452399a290e35b5a Mon Sep 17 00:00:00 2001
From: NikolajDanger <nikolajgade@live.dk>
Date: Mon, 10 Oct 2022 14:47:19 +0200
Subject: [PATCH] :sparkles:

---
 selflocalization/selflocalize.py | 2 ++
 1 file changed, 2 insertions(+)

diff --git a/selflocalization/selflocalize.py b/selflocalization/selflocalize.py
index a55b9ae..659c97e 100644
--- a/selflocalization/selflocalize.py
+++ b/selflocalization/selflocalize.py
@@ -258,6 +258,8 @@ try:
         print("est_weight:", est_weight)
         print("certainty:", certainty)
         if est_weight > 1:
+            draw_world(est_pose, particles, world)
+            cv2.imwrite("test.png", world)
             break
         else:
             arlo.go_diff(POWER, POWER, 0, 1)