Replace location_monitor_node.py

Simulation/location_monitor/scripts/location_monitor_node.py

@@ -111,8 +111,15 @@ def distance(x1, y1, x2, y2):
 
 
 def boxkdetection(size, botx, boty, l_x, l_y, simtime):
-  global f
-  global WriteFlag
+ global f
+ global WriteFlag
+ if (size*2.0) > 0.5:
+   print("Box to big, > 0.5")
+   if WriteFlag == 0:
+      f.write("[T:" + str(simtime) + "] " + "Box Invalid (size < 0.5)" + "\n")
+      f.close
+ else:
+  print("SIZEBOX" + str(size))
   cornerdist = (size)/math.sin(math.radians(45))
   safedist = TurtlebotBurger
   #print("Safe " + str(safedist))