diff --git a/src/sim/location_monitor/scripts/location_monitor_node.py b/src/sim/location_monitor/scripts/location_monitor_node.py index 2fa66a6c299ffba8564be8797e4c49b4a9c6d1af..f93868e749b5a99816aeb9d33f0df0772b24990d 100644 --- a/src/sim/location_monitor/scripts/location_monitor_node.py +++ b/src/sim/location_monitor/scripts/location_monitor_node.py @@ -300,6 +300,12 @@ def callback(msg): cordlist.append(botx + BotSides * math.cos(math.radians(yawBot-BotSideRad))) cordlist.append(boty + BotSides * math.sin(math.radians(yawBot-BotSideRad))) + # weitere Kollisionspunkte hinzufuegen falls noetig mittels: + # cordlist.append(botx + (Laenge) * math.cos(math.radians(yawBot(+-)(Radius auf vom Zentrum aus)))) + # cordlist.append(boty + (Laenge) * math.sin(math.radians(yawBot(+-)(Radius auf vom Zentrum aus)))) + + + detect.show_gazebo_models(cordlist) gc.collect()