diff --git a/Simulation/location_monitor/scripts/location_monitor_node.py b/Simulation/location_monitor/scripts/location_monitor_node.py index 019ef44ec759baa68b38e477c4b7a8a21e6d487a..850f2d7e297118c6a72509f5452913b2f2a5914d 100644 --- a/Simulation/location_monitor/scripts/location_monitor_node.py +++ b/Simulation/location_monitor/scripts/location_monitor_node.py @@ -5,11 +5,9 @@ import rospy from nav_msgs.msg import Odometry ob = [] - - - - - +ob.append((0.00 , -0.70)); #Beispeiele, befinden sich auf der X Linie +ob.append((0.00 , 0.00)); +ob.append((0.00 , 0.80)); def distance(x1, y1, x2, y2): xd = x1 - x2 @@ -24,7 +22,7 @@ def callback(msg): for l_x, l_y in ob: dist = distance(x, y, l_x, l_y) - if dist < 0.20: + if dist < 0.20: #muss individuell angepasst wreden rospy.loginfo("Collision!")