Book a Demo!
CoCalc Logo Icon
StoreFeaturesDocsShareSupportNewsAboutPoliciesSign UpSign In
eclipse
GitHub Repository: eclipse/sumo
Path: blob/main/tests/complex/traci/vehicle/moveToXY/multi_lane_sublane/runner.py
169720 views
1
#!/usr/bin/env python
2
# -*- coding: utf-8 -*-
3
# Eclipse SUMO, Simulation of Urban MObility; see https://eclipse.dev/sumo
4
# Copyright (C) 2008-2025 German Aerospace Center (DLR) and others.
5
# This program and the accompanying materials are made available under the
6
# terms of the Eclipse Public License 2.0 which is available at
7
# https://www.eclipse.org/legal/epl-2.0/
8
# This Source Code may also be made available under the following Secondary
9
# Licenses when the conditions for such availability set forth in the Eclipse
10
# Public License 2.0 are satisfied: GNU General Public License, version 2
11
# or later which is available at
12
# https://www.gnu.org/licenses/old-licenses/gpl-2.0-standalone.html
13
# SPDX-License-Identifier: EPL-2.0 OR GPL-2.0-or-later
14
15
# @file runner.py
16
# @author Jakob Erdmann
17
# @date 2017-01-23
18
19
20
from __future__ import print_function
21
from __future__ import absolute_import
22
import os
23
import sys
24
25
if "SUMO_HOME" in os.environ:
26
sys.path.append(os.path.join(os.environ["SUMO_HOME"], "tools"))
27
28
import traci # noqa
29
import sumolib # noqa
30
31
sumoBinary = sumolib.checkBinary("sumo")
32
cmd = [sumoBinary,
33
'-n', 'input_net2.net.xml',
34
'--lateral-resolution', '0.8',
35
'--no-step-log',
36
# '-S', '-Q',
37
]
38
39
ANGLE_UNDEF = traci.constants.INVALID_DOUBLE_VALUE
40
INVALID = traci.constants.INVALID_DOUBLE_VALUE
41
42
vehID = "v0"
43
44
45
def check(x, y, angle, exLane, exPos, exPosLat, comment, edgeHint="", laneHint=0):
46
traci.vehicle.moveToXY(vehID, edgeHint, laneHint, x, y, angle)
47
traci.simulationStep()
48
x2, y2 = traci.vehicle.getPosition(vehID)
49
lane2 = traci.vehicle.getLaneID(vehID)
50
pos2 = traci.vehicle.getLanePosition(vehID)
51
posLat2 = traci.vehicle.getLateralLanePosition(vehID)
52
if (abs(x - x2) > 0.1 or
53
abs(y - y2) > 0.1 or
54
(exLane != lane2 and exLane is not None) or
55
(exPos is not None and abs(exPos - pos2) > 0.1) or
56
(exPosLat is not None and abs(exPosLat - posLat2) > 0.1)):
57
print(comment, ("failed: x=%s, x2=%s, y=%s, y2=%s, lane=%s, lane2=%s, pos=%s, pos2=%s " +
58
"posLat=%s posLat2=%s") % (x, x2, y, y2, exLane, lane2, exPos, pos2, exPosLat, posLat2))
59
else:
60
# (comment, "success")
61
pass
62
print(traci.simulation.getTime(),
63
" lane=%s" % lane2,
64
# " route=%s" % str(traci.vehicle.getRoute(vehID)),
65
" right=%s, %s" % traci.vehicle.getLaneChangeStatePretty(vehID, -1),
66
" left=%s, %s" % traci.vehicle.getLaneChangeStatePretty(vehID, 1),
67
" accel=%s" % traci.vehicle.getAcceleration(vehID),
68
" nextTLS=%s" % traci.vehicle.getNextTLS(vehID),
69
" leader=%s" % (traci.vehicle.getLeader(vehID, 500),),
70
)
71
72
73
traci.start(cmd)
74
traci.setLegacyGetLeader(False)
75
traci.simulationStep()
76
traci.route.add("SE", ["SC", "CE"])
77
traci.vehicle.add(vehID, "SE")
78
check(104.95, 20, ANGLE_UNDEF, None, None, None, "correct lane")
79
check(104.95, 30, ANGLE_UNDEF, None, None, None, "correct lane")
80
check(104.95, 40, ANGLE_UNDEF, None, None, None, "correct lane")
81
check(101.65, 50, ANGLE_UNDEF, None, None, None, "correct lane")
82
check(101.65, 60, ANGLE_UNDEF, None, None, None, "correct lane")
83
check(101.65, 70, ANGLE_UNDEF, None, None, None, "correct lane")
84
check(101.65, 80, ANGLE_UNDEF, None, None, None, "correct lane")
85
# test misleading lane hints (vehicle is on SC_1 and should move to SC_0
86
check(104.95, 90, ANGLE_UNDEF, "SC_0", None, None, "correct lane", edgeHint="SC", laneHint=1)
87
traci.close()
88
89