diff --git a/Simulation/location_monitor/scripts/location_monitor_node.py b/Simulation/location_monitor/scripts/location_monitor_node.py index 3f526963f72a376fe9c145f2593a318cea8078bc..4eafffa2e3cd3331292734a5eb7b998ab97bccc4 100644 --- a/Simulation/location_monitor/scripts/location_monitor_node.py +++ b/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))