Lane.java
package org.opentrafficsim.road.network.lane;
import java.io.Serializable;
import java.util.ArrayList;
import java.util.Collections;
import java.util.LinkedHashMap;
import java.util.LinkedHashSet;
import java.util.List;
import java.util.Map;
import java.util.NavigableMap;
import java.util.Set;
import java.util.SortedMap;
import java.util.TreeMap;
import org.djunits.unit.LengthUnit;
import org.djunits.unit.TimeUnit;
import org.djunits.value.vdouble.scalar.Duration;
import org.djunits.value.vdouble.scalar.Length;
import org.djunits.value.vdouble.scalar.Speed;
import org.djunits.value.vdouble.scalar.Time;
import org.djutils.draw.line.Polygon2d;
import org.djutils.event.EventType;
import org.djutils.exceptions.Throw;
import org.djutils.immutablecollections.Immutable;
import org.djutils.immutablecollections.ImmutableArrayList;
import org.djutils.immutablecollections.ImmutableList;
import org.djutils.metadata.MetaData;
import org.djutils.metadata.ObjectDescriptor;
import org.djutils.multikeymap.MultiKeyMap;
import org.opentrafficsim.base.HierarchicallyTyped;
import org.opentrafficsim.core.SpatialObject;
import org.opentrafficsim.core.geometry.OtsLine2d;
import org.opentrafficsim.core.gtu.GtuException;
import org.opentrafficsim.core.gtu.GtuType;
import org.opentrafficsim.core.gtu.RelativePosition;
import org.opentrafficsim.core.gtu.plan.operational.OperationalPlan;
import org.opentrafficsim.core.network.LateralDirectionality;
import org.opentrafficsim.core.network.Link;
import org.opentrafficsim.core.network.NetworkException;
import org.opentrafficsim.core.perception.HistoryManager;
import org.opentrafficsim.core.perception.collections.HistoricalArrayList;
import org.opentrafficsim.core.perception.collections.HistoricalList;
import org.opentrafficsim.road.gtu.lane.LaneBasedGtu;
import org.opentrafficsim.road.network.lane.object.LaneBasedObject;
import org.opentrafficsim.road.network.lane.object.detector.Detector;
import org.opentrafficsim.road.network.lane.object.detector.LaneDetector;
import org.opentrafficsim.road.network.lane.object.detector.SinkDetector;
import nl.tudelft.simulation.dsol.SimRuntimeException;
import nl.tudelft.simulation.dsol.formalisms.eventscheduling.SimEvent;
/**
* The Lane is the CrossSectionElement of a CrossSectionLink on which GTUs can drive. The Lane stores several important
* properties, such as the successor lane(s), predecessor lane(s), and adjacent lane(s), all separated per GTU type. It can, for
* instance, be that a truck is not allowed to move into an adjacent lane, while a car is allowed to do so. Furthermore, the
* lane contains detectors that can be triggered by passing GTUs. The Lane class also contains methods to determine to trigger
* the detectors at exactly calculated and scheduled times, given the movement of the GTUs. <br>
* Finally, the Lane stores the GTUs on the lane, and contains several access methods to determine successor and predecessor
* GTUs, as well as methods to add a GTU to a lane (either at the start or in the middle when changing lanes), and remove a GTU
* from the lane (either at the end, or in the middle when changing onto another lane). The GTU is only booked with its
* reference point on the lane, and is -- unless during a lane change -- only booked on one lane at a time.
* <p>
* Copyright (c) 2013-2024 Delft University of Technology, PO Box 5, 2600 AA, Delft, the Netherlands. All rights reserved. <br>
* BSD-style license. See <a href="https://opentrafficsim.org/docs/license.html">OpenTrafficSim License</a>.
* </p>
* @author <a href="https://github.com/averbraeck">Alexander Verbraeck</a>
* @author <a href="https://tudelft.nl/staff/p.knoppers-1">Peter Knoppers</a>
*/
public class Lane extends CrossSectionElement implements HierarchicallyTyped<LaneType, Lane>, SpatialObject, Serializable
{
/** */
private static final long serialVersionUID = 20150826L;
/** Type of lane to deduce compatibility with GTU types. */
private final LaneType laneType;
/**
* The speed limit of this lane, which can differ per GTU type. Cars might be allowed to drive 120 km/h and trucks 90 km/h.
* If the speed limit is the same for a family of GTU types, that family name (e.g., GtuType.VEHICLE) can be used. <br>
*/
private final Map<GtuType, Speed> speedLimitMap = new LinkedHashMap<>();
/** Cached speed limits; these are cleared when a speed limit is changed. */
private final Map<GtuType, Speed> cachedSpeedLimits = new LinkedHashMap<>();
/**
* Detectors on the lane to trigger behavior of the GTU, sorted by longitudinal position. The triggering of detectors is
* done per GTU type, so different GTUs can trigger different detectors.
*/
private final SortedMap<Double, List<LaneDetector>> detectors = new TreeMap<>();
/**
* Objects on the lane can be observed by the GTU. Examples are signs, speed signs, blocks, and traffic lights. They are
* sorted by longitudinal position.
*/
private final SortedMap<Double, List<LaneBasedObject>> laneBasedObjects = new TreeMap<>();
/** GTUs ordered by increasing longitudinal position; increasing in the direction of the center line. */
private final HistoricalList<LaneBasedGtu> gtuList;
/** Last returned past GTU list. */
private List<LaneBasedGtu> gtuListAtTime = null;
/** Time of last returned GTU list. */
private Time gtuListTime = null;
/**
* Adjacent left lanes that some GTU types can change onto. Left is defined relative to the direction of the design line of
* the link (and the direction of the center line of the lane). In terms of offsets, 'left' lanes always have a more
* positive offset than the current lane. Initially empty so we can calculate and cache the first time the method is called.
*/
private final MultiKeyMap<Set<Lane>> leftNeighbours = new MultiKeyMap<>(GtuType.class, Boolean.class);
/**
* Adjacent right lanes that some GTU types can change onto. Right is defined relative to the direction of the design line
* of the link (and the direction of the center line of the lane). In terms of offsets, 'right' lanes always have a more
* negative offset than the current lane. Initially empty so we can calculate and cache the first time the method is called.
*/
private final MultiKeyMap<Set<Lane>> rightNeighbours = new MultiKeyMap<>(GtuType.class, Boolean.class);
/**
* Next lane(s) following this lane that some GTU types can drive onto. Next is defined in the direction of the design line.
* Initially empty so we can calculate and cache the first time the method is called.
*/
private final Map<GtuType, Set<Lane>> nextLanes = new LinkedHashMap<>(1);
/**
* Previous lane(s) preceding this lane that some GTU types can drive from. Previous is defined relative to the direction of
* the design line. Initially empty so we can calculate and cache the first time the method is called.
*/
private final Map<GtuType, Set<Lane>> prevLanes = new LinkedHashMap<>(1);
/**
* The <b>timed</b> event type for pub/sub indicating the addition of a GTU to the lane. <br>
* Payload: Object[] {String gtuId, int count_after_addition, String laneId, String linkId}
*/
public static final EventType GTU_ADD_EVENT = new EventType("LANE.GTU.ADD",
new MetaData("Lane GTU add", "GTU id, number of GTUs after addition, lane id, link id",
new ObjectDescriptor("GTU id", "Id of GTU", String.class),
new ObjectDescriptor("GTU count", "New number of GTUs on lane", Integer.class),
new ObjectDescriptor("Lane id", "Id of the lane", String.class),
new ObjectDescriptor("Link id", "Id of the link", String.class)));
/**
* The <b>timed</b> event type for pub/sub indicating the removal of a GTU from the lane. <br>
* Payload: Object[] {String gtuId, LaneBasedGtu gtu, int count_after_removal, Length position, String laneId, String
* linkId}
*/
public static final EventType GTU_REMOVE_EVENT = new EventType("LANE.GTU.REMOVE",
new MetaData("Lane GTU remove", "GTU id, gtu, number of GTUs after removal, position, lane id, link id",
new ObjectDescriptor("GTU id", "Id of GTU", String.class),
new ObjectDescriptor("GTU", "The GTU itself", LaneBasedGtu.class),
new ObjectDescriptor("GTU count", "New number of GTUs on lane", Integer.class),
new ObjectDescriptor("Position", "Last position of GTU on the lane", Length.class),
new ObjectDescriptor("Lane id", "Id of the lane", String.class),
new ObjectDescriptor("Link id", "Id of the link", String.class)));
/**
* The <b>timed</b> event type for pub/sub indicating the addition of a Detector to the lane. <br>
* Payload: Object[] {String detectorId, Detector detector}
*/
public static final EventType DETECTOR_ADD_EVENT = new EventType("LANE.DETECTOR.ADD",
new MetaData("Lane detector add", "Detector id, detector",
new ObjectDescriptor("detector id", "id of detector", String.class),
new ObjectDescriptor("detector", "detector itself", Detector.class)));
/**
* The <b>timed</b> event type for pub/sub indicating the removal of a Detector from the lane. <br>
* Payload: Object[] {String detectorId, Detector detector}
*/
public static final EventType DETECTOR_REMOVE_EVENT = new EventType("LANE.DETECTOR.REMOVE",
new MetaData("Lane detector remove", "Detector id, detector",
new ObjectDescriptor("detector id", "id of detector", String.class),
new ObjectDescriptor("detector", "detector itself", Detector.class)));
/**
* The event type for pub/sub indicating the addition of a LaneBasedObject to the lane. <br>
* Payload: Object[] {LaneBasedObject laneBasedObject}
*/
public static final EventType OBJECT_ADD_EVENT = new EventType("LANE.OBJECT.ADD", new MetaData("Lane object add", "Object",
new ObjectDescriptor("GTU", "The lane-based GTU", LaneBasedObject.class)));
/**
* The event type for pub/sub indicating the removal of a LaneBasedObject from the lane. <br>
* Payload: Object[] {LaneBasedObject laneBasedObject}
*/
public static final EventType OBJECT_REMOVE_EVENT = new EventType("LANE.OBJECT.REMOVE", new MetaData("Lane object remove",
"Object", new ObjectDescriptor("GTU", "The lane-based GTU", LaneBasedObject.class)));
/**
* Constructor specifying geometry.
* @param link CrossSectionLink; link.
* @param id String; the id of this lane within the link; should be unique within the link.
* @param centerLine OtsLine2d; center line.
* @param contour Polygon2d; contour shape.
* @param crossSectionSlices List<CrossSectionSlice>; cross-section slices.
* @param laneType LaneType; lane type.
* @param speedLimitMap Map<GtuType, Speed>; the speed limit on this lane, specified per GTU Type.
* @throws NetworkException when no cross-section slice is defined.
*/
public Lane(final CrossSectionLink link, final String id, final OtsLine2d centerLine, final Polygon2d contour,
final List<CrossSectionSlice> crossSectionSlices, final LaneType laneType, final Map<GtuType, Speed> speedLimitMap)
throws NetworkException
{
super(link, id, centerLine, contour, crossSectionSlices);
this.laneType = laneType;
this.speedLimitMap.putAll(speedLimitMap);
this.gtuList = new HistoricalArrayList<>(getManager(link));
}
/**
* Obtains the history manager from the parent link.
* @param parentLink CrossSectionLink; parent link
* @return HistoryManager; history manager
*/
private HistoryManager getManager(final CrossSectionLink parentLink)
{
return parentLink.getSimulator().getReplication().getHistoryManager(parentLink.getSimulator());
}
// TODO constructor calls with this(...)
/**
* Retrieve one of the sets of neighboring Lanes that is accessible for the given type of GTU. A defensive copy of the
* internal data structure is returned.
* @param direction LateralDirectionality; either LEFT or RIGHT, relative to the DESIGN LINE of the link (and the direction
* of the center line of the lane). In terms of offsets, 'left' lanes always have a more positive offset than the
* current lane, and 'right' lanes a more negative offset.
* @param gtuType GtuType; the GTU type to check the accessibility for
* @param legal boolean; whether to check legal possibility
* @return Set<Lane>; the indicated set of neighboring Lanes
*/
private Set<Lane> neighbors(final LateralDirectionality direction, final GtuType gtuType, final boolean legal)
{
MultiKeyMap<Set<Lane>> cache = direction.isLeft() ? this.leftNeighbours : this.rightNeighbours;
return cache.get(() ->
{
Set<Lane> lanes = new LinkedHashSet<>(1);
for (CrossSectionElement cse : this.link.getCrossSectionElementList())
{
if (cse instanceof Lane && !cse.equals(this))
{
Lane lane = (Lane) cse;
if (laterallyAdjacentAndAccessible(lane, direction, gtuType, legal))
{
lanes.add(lane);
}
}
}
return lanes;
}, gtuType, legal);
}
/** Lateral alignment margin for longitudinally connected Lanes. */
static final Length ADJACENT_MARGIN = new Length(0.2, LengthUnit.METER);
/**
* Determine whether another lane is adjacent to this lane (dependent on distance) and accessible (dependent on stripes) for
* a certain GTU type (dependent on usability of the adjacent lane for that GTU type). This method assumes that when there
* is NO stripe between two adjacent lanes that are accessible for the GTU type, the GTU can enter that lane. <br>
* @param lane Lane; the other lane to evaluate
* @param direction LateralDirectionality; the direction to look at, relative to the DESIGN LINE of the link. This is a very
* important aspect to note: all information is stored relative to the direction of the design line, and not in a
* driving direction, which can vary for lanes that can be driven in two directions (e.g. at overtaking).
* @param gtuType GtuType; the GTU type to check the accessibility for
* @param legal boolean; whether to check legal possibility
* @return boolean; true if the other lane is adjacent to this lane and accessible for the given GTU type; false otherwise
*/
private boolean laterallyAdjacentAndAccessible(final Lane lane, final LateralDirectionality direction,
final GtuType gtuType, final boolean legal)
{
if (legal && !lane.getType().isCompatible(gtuType))
{
// not accessible for the given GTU type
return false;
}
if (direction.equals(LateralDirectionality.LEFT))
{
// TODO take the cross section slices into account...
if (lane.getOffsetAtBegin().si + ADJACENT_MARGIN.si > getOffsetAtBegin().si
&& lane.getOffsetAtEnd().si + ADJACENT_MARGIN.si > getOffsetAtEnd().si
&& (lane.getOffsetAtBegin().si - lane.getBeginWidth().si / 2.0)
- (getOffsetAtBegin().si + getBeginWidth().si / 2.0) < ADJACENT_MARGIN.si
&& (lane.getOffsetAtEnd().si - lane.getEndWidth().si / 2.0)
- (getOffsetAtEnd().si + getEndWidth().si / 2.0) < ADJACENT_MARGIN.si)
{
// look at stripes between the two lanes
if (!(this instanceof Shoulder) && legal) // may always leave shoulder
{
for (CrossSectionElement cse : this.link.getCrossSectionElementList())
{
if (cse instanceof Stripe)
{
Stripe stripe = (Stripe) cse;
// TODO take the cross section slices into account...
if ((getOffsetAtBegin().si < stripe.getOffsetAtBegin().si
&& stripe.getOffsetAtBegin().si < lane.getOffsetAtBegin().si)
|| (getOffsetAtEnd().si < stripe.getOffsetAtEnd().si
&& stripe.getOffsetAtEnd().si < lane.getOffsetAtEnd().si))
{
if (!stripe.isPermeable(gtuType, LateralDirectionality.LEFT))
{
// there is a stripe forbidding to cross to the adjacent lane
return false;
}
}
}
}
}
// the lanes are adjacent, and there is no stripe forbidding us to enter that lane
// or there is no stripe at all
return true;
}
}
else
// direction.equals(LateralDirectionality.RIGHT)
{
// TODO take the cross section slices into account...
if (lane.getOffsetAtBegin().si < getOffsetAtBegin().si + ADJACENT_MARGIN.si
&& lane.getOffsetAtEnd().si < getOffsetAtEnd().si + ADJACENT_MARGIN.si
&& (getOffsetAtBegin().si - getBeginWidth().si / 2.0)
- (lane.getOffsetAtBegin().si + lane.getBeginWidth().si / 2.0) < ADJACENT_MARGIN.si
&& (getOffsetAtEnd().si - getEndWidth().si / 2.0)
- (lane.getOffsetAtEnd().si + lane.getEndWidth().si / 2.0) < ADJACENT_MARGIN.si)
{
// look at stripes between the two lanes
if (legal)
{
for (CrossSectionElement cse : this.link.getCrossSectionElementList())
{
if (cse instanceof Stripe)
{
Stripe stripe = (Stripe) cse;
// TODO take the cross section slices into account...
if ((getOffsetAtBegin().si > stripe.getOffsetAtBegin().si
&& stripe.getOffsetAtBegin().si > lane.getOffsetAtBegin().si)
|| (getOffsetAtEnd().si > stripe.getOffsetAtEnd().si
&& stripe.getOffsetAtEnd().si > lane.getOffsetAtEnd().si))
{
if (!stripe.isPermeable(gtuType, LateralDirectionality.RIGHT))
{
// there is a stripe forbidding to cross to the adjacent lane
return false;
}
}
}
}
}
// the lanes are adjacent, and there is no stripe forbidding us to enter that lane
// or there is no stripe at all
return true;
}
}
// no lanes were found that are close enough laterally.
return false;
}
/**
* Insert a detector at the right place in the detector list of this Lane.
* @param detector Detector; the detector to add
* @throws NetworkException when the position of the detector is beyond (or before) the range of this Lane
*/
public final void addDetector(final LaneDetector detector) throws NetworkException
{
double position = detector.getLongitudinalPosition().si;
if (position < 0 || position > getLength().getSI())
{
throw new NetworkException(
"Illegal position for detector " + position + " valid range is 0.." + getLength().getSI());
}
if (this.link.getNetwork().containsObject(detector.getFullId()))
{
throw new NetworkException("Network already contains an object with the name " + detector.getFullId());
}
List<LaneDetector> detectorList = this.detectors.get(position);
if (null == detectorList)
{
detectorList = new ArrayList<>(1);
this.detectors.put(position, detectorList);
}
detectorList.add(detector);
this.link.getNetwork().addObject(detector);
fireTimedEvent(Lane.DETECTOR_ADD_EVENT, new Object[] {detector.getId(), detector},
detector.getSimulator().getSimulatorTime());
}
/**
* Remove a detector from the detector list of this Lane.
* @param detector Detector; the detector to remove.
* @throws NetworkException when the detector was not found on this Lane
*/
public final void removeDetector(final LaneDetector detector) throws NetworkException
{
fireTimedEvent(Lane.DETECTOR_REMOVE_EVENT, new Object[] {detector.getId(), detector},
detector.getSimulator().getSimulatorTime());
List<LaneDetector> detectorList = this.detectors.get(detector.getLongitudinalPosition().si);
if (null == detectorList)
{
throw new NetworkException("No detector at " + detector.getLongitudinalPosition().si);
}
detectorList.remove(detector);
if (detectorList.size() == 0)
{
this.detectors.remove(detector.getLongitudinalPosition().si);
}
this.link.getNetwork().removeObject(detector);
}
/**
* Retrieve the list of Detectors of this Lane in the specified distance range for the given GtuType. The resulting list is
* a defensive copy.
* @param minimumPosition Length; the minimum distance on the Lane (inclusive)
* @param maximumPosition Length; the maximum distance on the Lane (inclusive)
* @param gtuType GtuType; the GTU type to provide the detectors for
* @return List<Detector>; list of the detectors in the specified range. This is a defensive copy.
*/
public final List<LaneDetector> getDetectors(final Length minimumPosition, final Length maximumPosition,
final GtuType gtuType)
{
List<LaneDetector> detectorList = new ArrayList<>(1);
for (List<LaneDetector> dets : this.detectors.values())
{
for (LaneDetector detector : dets)
{
if (detector.isCompatible(gtuType) && detector.getLongitudinalPosition().ge(minimumPosition)
&& detector.getLongitudinalPosition().le(maximumPosition))
{
detectorList.add(detector);
}
}
}
return detectorList;
}
/**
* Retrieve the list of Detectors of this Lane that are triggered by the given GtuType. The resulting list is a defensive
* copy.
* @param gtuType GtuType; the GTU type to provide the detectors for
* @return List<Detector>; list of the detectors, in ascending order for the location on the Lane
*/
public final List<LaneDetector> getDetectors(final GtuType gtuType)
{
List<LaneDetector> detectorList = new ArrayList<>(1);
for (List<LaneDetector> dets : this.detectors.values())
{
for (LaneDetector detector : dets)
{
if (detector.isCompatible(gtuType))
{
detectorList.add(detector);
}
}
}
return detectorList;
}
/**
* Retrieve the list of all Detectors of this Lane. The resulting list is a defensive copy.
* @return List<Detector>; list of the detectors, in ascending order for the location on the Lane
*/
public final List<LaneDetector> getDetectors()
{
if (this.detectors == null)
{
return new ArrayList<>();
}
List<LaneDetector> detectorList = new ArrayList<>(1);
for (List<LaneDetector> dets : this.detectors.values())
{
for (LaneDetector detector : dets)
{
detectorList.add(detector);
}
}
return detectorList;
}
/**
* Retrieve the list of Detectors of this Lane for the given GtuType. The resulting Map is a defensive copy.
* @param gtuType GtuType; the GTU type to provide the detectors for
* @return SortedMap<Double, List<Detector>>; all detectors on this lane for the given GtuType as a map per
* distance
*/
public final SortedMap<Double, List<LaneDetector>> getDetectorMap(final GtuType gtuType)
{
SortedMap<Double, List<LaneDetector>> detectorMap = new TreeMap<>();
for (double d : this.detectors.keySet())
{
List<LaneDetector> detectorList = new ArrayList<>(1);
for (List<LaneDetector> dets : this.detectors.values())
{
for (LaneDetector detector : dets)
{
if (detector.getLongitudinalPosition().si == d && detector.isCompatible(gtuType))
{
detectorList.add(detector);
}
}
}
if (detectorList.size() > 0)
{
detectorMap.put(d, detectorList);
}
}
return detectorMap;
}
/**
* Schedule triggering of the detectors for a certain time step; from now until the nextEvaluationTime of the GTU.
* @param gtu LaneBasedGtu; the lane based GTU for which to schedule triggering of the detectors.
* @param referenceStartSI double; the SI distance of the GTU reference point on the lane at the current time
* @param referenceMoveSI double; the SI distance travelled in the next time step.
* @throws NetworkException when GTU not on this lane.
* @throws SimRuntimeException when method cannot be scheduled.
*/
public final void scheduleDetectorTriggers(final LaneBasedGtu gtu, final double referenceStartSI,
final double referenceMoveSI) throws NetworkException, SimRuntimeException
{
double minPos = referenceStartSI + gtu.getRear().dx().si;
double maxPos = referenceStartSI + gtu.getFront().dx().si + referenceMoveSI;
Map<Double, List<LaneDetector>> map = this.detectors.subMap(minPos, maxPos);
for (double pos : map.keySet())
{
for (LaneDetector detector : map.get(pos))
{
if (detector.isCompatible(gtu.getType()))
{
double dx = gtu.getRelativePositions().get(detector.getPositionType()).dx().si;
minPos = referenceStartSI + dx;
maxPos = minPos + referenceMoveSI;
if (minPos <= detector.getLongitudinalPosition().si && maxPos > detector.getLongitudinalPosition().si)
{
double d = detector.getLongitudinalPosition().si - minPos;
if (d < 0)
{
throw new NetworkException("scheduleTriggers for gtu: " + gtu + ", d<0 d=" + d);
}
OperationalPlan oPlan = gtu.getOperationalPlan();
Time triggerTime = oPlan.timeAtDistance(Length.instantiateSI(d));
if (triggerTime.gt(oPlan.getEndTime()))
{
System.err.println("Time=" + gtu.getSimulator().getSimulatorTime().getSI()
+ " - Scheduling trigger at " + triggerTime.getSI() + "s. > " + oPlan.getEndTime().getSI()
+ "s. (nextEvalTime) for detector " + detector + " , gtu " + gtu);
System.err.println(" v=" + gtu.getSpeed() + ", a=" + gtu.getAcceleration() + ", lane=" + toString()
+ ", refStartSI=" + referenceStartSI + ", moveSI=" + referenceMoveSI);
triggerTime = new Time(oPlan.getEndTime().getSI() - Math.ulp(oPlan.getEndTime().getSI()),
TimeUnit.DEFAULT);
}
SimEvent<Duration> event =
new SimEvent<>(new Duration(triggerTime.minus(gtu.getSimulator().getStartTimeAbs())), detector,
"trigger", new Object[] {gtu});
gtu.getSimulator().scheduleEvent(event);
gtu.addTrigger(this, event);
}
else if (detector.getLongitudinalPosition().si < minPos && detector instanceof SinkDetector)
{
// TODO this is a hack for when sink detectors aren't perfectly adjacent or the GTU overshoots with nose
// due to curvature
SimEvent<Duration> event = new SimEvent<>(new Duration(gtu.getSimulator().getSimulatorTime()), detector,
"trigger", new Object[] {gtu});
gtu.getSimulator().scheduleEvent(event);
gtu.addTrigger(this, event);
}
}
}
}
}
/**
* Insert a laneBasedObject at the right place in the laneBasedObject list of this Lane. Register it in the network WITH the
* Lane id.
* @param laneBasedObject LaneBasedObject; the laneBasedObject to add
* @throws NetworkException when the position of the laneBasedObject is beyond (or before) the range of this Lane
*/
public final synchronized void addLaneBasedObject(final LaneBasedObject laneBasedObject) throws NetworkException
{
double position = laneBasedObject.getLongitudinalPosition().si;
if (position < 0 || position > getLength().getSI())
{
throw new NetworkException(
"Illegal position for laneBasedObject " + position + " valid range is 0.." + getLength().getSI());
}
if (this.link.getNetwork().containsObject(laneBasedObject.getFullId()))
{
throw new NetworkException("Network already contains an object with the name " + laneBasedObject.getFullId());
}
List<LaneBasedObject> laneBasedObjectList = this.laneBasedObjects.get(position);
if (null == laneBasedObjectList)
{
laneBasedObjectList = new ArrayList<>(1);
this.laneBasedObjects.put(position, laneBasedObjectList);
}
laneBasedObjectList.add(laneBasedObject);
this.link.getNetwork().addObject(laneBasedObject);
fireTimedEvent(Lane.OBJECT_ADD_EVENT, new Object[] {laneBasedObject}, getLink().getSimulator().getSimulatorTime());
}
/**
* Remove a laneBasedObject from the laneBasedObject list of this Lane.
* @param laneBasedObject LaneBasedObject; the laneBasedObject to remove.
* @throws NetworkException when the laneBasedObject was not found on this Lane
*/
public final synchronized void removeLaneBasedObject(final LaneBasedObject laneBasedObject) throws NetworkException
{
fireTimedEvent(Lane.OBJECT_REMOVE_EVENT, new Object[] {laneBasedObject}, getLink().getSimulator().getSimulatorTime());
List<LaneBasedObject> laneBasedObjectList =
this.laneBasedObjects.get(laneBasedObject.getLongitudinalPosition().getSI());
if (null == laneBasedObjectList)
{
throw new NetworkException("No laneBasedObject at " + laneBasedObject.getLongitudinalPosition().si);
}
laneBasedObjectList.remove(laneBasedObject);
if (laneBasedObjectList.isEmpty())
{
this.laneBasedObjects.remove(laneBasedObject.getLongitudinalPosition().doubleValue());
}
this.link.getNetwork().removeObject(laneBasedObject);
}
/**
* Retrieve the list of LaneBasedObjects of this Lane in the specified distance range. The resulting list is a defensive
* copy.
* @param minimumPosition Length; the minimum distance on the Lane (inclusive)
* @param maximumPosition Length; the maximum distance on the Lane (inclusive)
* @return List<LaneBasedObject>; list of the laneBasedObject in the specified range. This is a defensive copy.
*/
public final List<LaneBasedObject> getLaneBasedObjects(final Length minimumPosition, final Length maximumPosition)
{
List<LaneBasedObject> laneBasedObjectList = new ArrayList<>(1);
for (List<LaneBasedObject> lbol : this.laneBasedObjects.values())
{
for (LaneBasedObject lbo : lbol)
{
if (lbo.getLongitudinalPosition().ge(minimumPosition) && lbo.getLongitudinalPosition().le(maximumPosition))
{
laneBasedObjectList.add(lbo);
}
}
}
return laneBasedObjectList;
}
/**
* Retrieve the list of all LaneBasedObjects of this Lane. The resulting list is a defensive copy.
* @return List<LaneBasedObject>; list of the laneBasedObjects, in ascending order for the location on the Lane
*/
public final List<LaneBasedObject> getLaneBasedObjects()
{
if (this.laneBasedObjects == null)
{
return new ArrayList<>();
}
List<LaneBasedObject> laneBasedObjectList = new ArrayList<>(1);
for (List<LaneBasedObject> lbol : this.laneBasedObjects.values())
{
for (LaneBasedObject lbo : lbol)
{
laneBasedObjectList.add(lbo);
}
}
return laneBasedObjectList;
}
/**
* Retrieve the list of LaneBasedObjects of this Lane. The resulting Map is a defensive copy.
* @return SortedMap<Double, List<LaneBasedObject>>; all laneBasedObjects on this lane
*/
public final SortedMap<Double, List<LaneBasedObject>> getLaneBasedObjectMap()
{
SortedMap<Double, List<LaneBasedObject>> laneBasedObjectMap = new TreeMap<>();
for (double d : this.laneBasedObjects.keySet())
{
List<LaneBasedObject> laneBasedObjectList = new ArrayList<>(1);
for (LaneBasedObject lbo : this.laneBasedObjects.get(d))
{
laneBasedObjectList.add(lbo);
}
laneBasedObjectMap.put(d, laneBasedObjectList);
}
return laneBasedObjectMap;
}
/**
* Transform a fraction on the lane to a relative length (can be less than zero or larger than the lane length).
* @param fraction double; fraction relative to the lane length.
* @return Length; the longitudinal length corresponding to the fraction.
*/
public final Length position(final double fraction)
{
if (getLength().getDisplayUnit().isBaseSIUnit())
{
return new Length(getLength().si * fraction, LengthUnit.SI);
}
return new Length(getLength().getInUnit() * fraction, getLength().getDisplayUnit());
}
/**
* Transform a fraction on the lane to a relative length in SI units (can be less than zero or larger than the lane length).
* @param fraction double; fraction relative to the lane length.
* @return double; length corresponding to the fraction, in SI units.
*/
public final double positionSI(final double fraction)
{
return getLength().si * fraction;
}
/**
* Transform a position on the lane (can be less than zero or larger than the lane length) to a fraction.
* @param position Length; relative length on the lane (may be less than zero or larger than the lane length).
* @return fraction double; fraction relative to the lane length.
*/
public final double fraction(final Length position)
{
return position.si / getLength().si;
}
/**
* Transform a position on the lane in SI units (can be less than zero or larger than the lane length) to a fraction.
* @param positionSI double; relative length on the lane in SI units (may be less than zero or larger than the lane length).
* @return double; fraction relative to the lane length.
*/
public final double fractionSI(final double positionSI)
{
return positionSI / getLength().si;
}
/** {@inheritDoc} */
@Override
public Polygon2d getShape()
{
return getContour();
}
/**
* Add a LaneBasedGtu to the list of this Lane.
* @param gtu LaneBasedGtu; the GTU to add
* @param fractionalPosition double; the fractional position that the newly added GTU will have on this Lane
* @return int; the rank that the newly added GTU has on this Lane (should be 0, except when the GTU enters this Lane due to
* a lane change operation)
* @throws GtuException when the fractionalPosition is outside the range 0..1, or the GTU is already registered on this Lane
*/
// @docs/02-model-structure/djutils.md#event-producers-and-listeners
public final int addGtu(final LaneBasedGtu gtu, final double fractionalPosition) throws GtuException
{
int index;
// check if we are the first
if (this.gtuList.size() == 0)
{
this.gtuList.add(gtu);
index = 0;
}
else
{
// figure out the rank for the new GTU
for (index = 0; index < this.gtuList.size(); index++)
{
LaneBasedGtu otherGTU = this.gtuList.get(index);
if (gtu == otherGTU)
{
throw new GtuException(gtu + " already registered on Lane " + this + " [registered lanes: "
+ gtu.positions(gtu.getFront()).keySet() + "] locations: " + gtu.positions(gtu.getFront()).values()
+ " time: " + gtu.getSimulator().getSimulatorTime());
}
if (otherGTU.fractionalPosition(this, otherGTU.getFront()) >= fractionalPosition)
{
break;
}
}
this.gtuList.add(index, gtu);
}
// @docs/02-model-structure/djutils.md#event-producers-and-listeners
fireTimedEvent(Lane.GTU_ADD_EVENT, new Object[] {gtu.getId(), this.gtuList.size(), getId(), getLink().getId()},
gtu.getSimulator().getSimulatorTime());
// @end
getLink().addGTU(gtu);
return index;
}
/**
* Add a LaneBasedGtu to the list of this Lane.
* @param gtu LaneBasedGtu; the GTU to add
* @param longitudinalPosition Length; the longitudinal position that the newly added GTU will have on this Lane
* @return int; the rank that the newly added GTU has on this Lane (should be 0, except when the GTU enters this Lane due to
* a lane change operation)
* @throws GtuException when longitudinalPosition is negative or exceeds the length of this Lane
*/
public final int addGtu(final LaneBasedGtu gtu, final Length longitudinalPosition) throws GtuException
{
return addGtu(gtu, longitudinalPosition.getSI() / getLength().getSI());
}
/**
* Remove a GTU from the GTU list of this lane.
* @param gtu LaneBasedGtu; the GTU to remove.
* @param removeFromParentLink boolean; when the GTU leaves the last lane of the parentLink of this Lane
* @param position Length; last position of the GTU
*/
// @docs/02-model-structure/djutils.md#event-producers-and-listeners
public final void removeGtu(final LaneBasedGtu gtu, final boolean removeFromParentLink, final Length position)
{
boolean contained = this.gtuList.remove(gtu);
if (contained)
{
// @docs/02-model-structure/djutils.md#event-producers-and-listeners
fireTimedEvent(Lane.GTU_REMOVE_EVENT,
new Object[] {gtu.getId(), gtu, this.gtuList.size(), position, getId(), getLink().getId()},
gtu.getSimulator().getSimulatorTime());
// @end
}
if (removeFromParentLink)
{
this.link.removeGTU(gtu);
}
}
/**
* Get the last GTU on the lane, relative to a driving direction on this lane.
* @return LaneBasedGtu; the last GTU on this lane in the given direction, or null if no GTU could be found.
* @throws GtuException when there is a problem with the position of the GTUs on the lane.
*/
public final LaneBasedGtu getLastGtu() throws GtuException
{
if (this.gtuList.size() == 0)
{
return null;
}
return this.gtuList.get(this.gtuList.size() - 1);
}
/**
* Get the first GTU on the lane, relative to a driving direction on this lane.
* @return LaneBasedGtu; the first GTU on this lane in the given direction, or null if no GTU could be found.
* @throws GtuException when there is a problem with the position of the GTUs on the lane.
*/
public final LaneBasedGtu getFirstGtu() throws GtuException
{
if (this.gtuList.size() == 0)
{
return null;
}
return this.gtuList.get(0);
}
/**
* Get the first GTU where the relativePosition is in front of another GTU on the lane, in a driving direction on this lane,
* compared to the DESIGN LINE.
* @param position Length; the position before which the relative position of a GTU will be searched.
* @param relativePosition RelativePosition.TYPE; the relative position we want to compare against
* @param when Time; the time for which to evaluate the positions.
* @return LaneBasedGtu; the first GTU before a position on this lane in the given direction, or null if no GTU could be
* found.
* @throws GtuException when there is a problem with the position of the GTUs on the lane.
*/
public final LaneBasedGtu getGtuAhead(final Length position, final RelativePosition.Type relativePosition, final Time when)
throws GtuException
{
List<LaneBasedGtu> list = this.gtuList.get(when);
if (list.isEmpty())
{
return null;
}
int[] search = lineSearch((final int index) ->
{
LaneBasedGtu gtu = list.get(index);
return gtu.position(this, gtu.getRelativePositions().get(relativePosition), when).si;
}, list.size(), position.si);
if (search[1] < list.size())
{
return list.get(search[1]);
}
return null;
}
/**
* Get the first GTU where the relativePosition is behind a certain position on the lane, in a driving direction on this
* lane, compared to the DESIGN LINE.
* @param position Length; the position before which the relative position of a GTU will be searched.
* @param relativePosition RelativePosition.TYPE; the relative position of the GTU we are looking for.
* @param when Time; the time for which to evaluate the positions.
* @return LaneBasedGtu; the first GTU after a position on this lane in the given direction, or null if no GTU could be
* found.
* @throws GtuException when there is a problem with the position of the GTUs on the lane.
*/
public final LaneBasedGtu getGtuBehind(final Length position, final RelativePosition.Type relativePosition, final Time when)
throws GtuException
{
List<LaneBasedGtu> list = this.gtuList.get(when);
if (list.isEmpty())
{
return null;
}
int[] search = lineSearch((final int index) ->
{
LaneBasedGtu gtu = list.get(index);
return gtu.position(this, gtu.getRelativePositions().get(relativePosition), when).si;
}, list.size(), position.si);
if (search[0] >= 0)
{
return list.get(search[0]);
}
return null;
}
/**
* Searches for objects just before and after a given position.
* @param positions Positions; functional interface returning positions at indices
* @param listSize int; number of objects in the underlying list
* @param position double; position
* @return int[2]; Where int[0] is the index of the object with lower position, and int[1] with higher. In case an object is
* exactly at the position int[1] - int[0] = 2. If all objects have a higher position int[0] = -1, if all objects
* have a lower position int[1] = listSize.
* @throws GtuException ...
*/
private int[] lineSearch(final Positions positions, final int listSize, final double position) throws GtuException
{
int[] out = new int[2];
// line search only works if the position is within the original domain, first catch 4 outside situations
double pos0 = positions.get(0);
double posEnd;
if (position < pos0)
{
out[0] = -1;
out[1] = 0;
}
else if (position == pos0)
{
out[0] = -1;
out[1] = 1;
}
else if (position > (posEnd = positions.get(listSize - 1)))
{
out[0] = listSize - 1;
out[1] = listSize;
}
else if (position == posEnd)
{
out[0] = listSize - 2;
out[1] = listSize;
}
else
{
int low = 0;
int mid = (int) ((listSize - 1) * position / getLength().si);
mid = mid < 0 ? 0 : mid >= listSize ? listSize - 1 : mid;
int high = listSize - 1;
while (high - low > 1)
{
double midPos = positions.get(mid);
if (midPos < position)
{
low = mid;
}
else if (midPos > position)
{
high = mid;
}
else
{
low = mid - 1;
high = mid + 1;
break;
}
mid = (low + high) / 2;
}
out[0] = low;
out[1] = high;
}
return out;
}
/**
* Get the first object where the relativePosition is in front of a certain position on the lane, in a driving direction on
* this lane, compared to the DESIGN LINE. Perception should iterate over results from this method to see what is most
* limiting.
* @param position Length; the position after which the relative position of an object will be searched.
* @return List<LaneBasedObject>; the first object(s) before a position on this lane in the given direction, or null
* if no object could be found.
*/
public final List<LaneBasedObject> getObjectAhead(final Length position)
{
for (double distance : this.laneBasedObjects.keySet())
{
if (distance > position.si)
{
return new ArrayList<>(this.laneBasedObjects.get(distance));
}
}
return null;
}
/**
* Get the first object where the relativePosition is behind of a certain position on the lane, in a driving direction on
* this lane, compared to the DESIGN LINE. Perception should iterate over results from this method to see what is most
* limiting.
* @param position Length; the position after which the relative position of an object will be searched.
* @return List<LaneBasedObject>; the first object(s) after a position on this lane in the given direction, or null if
* no object could be found.
*/
public final List<LaneBasedObject> getObjectBehind(final Length position)
{
NavigableMap<Double, List<LaneBasedObject>> reverseLBO =
(NavigableMap<Double, List<LaneBasedObject>>) this.laneBasedObjects;
for (double distance : reverseLBO.descendingKeySet())
{
if (distance < position.si)
{
return new ArrayList<>(this.laneBasedObjects.get(distance));
}
}
return null;
}
/*
* TODO only center position? Or also width? What is a good cutoff? Base on average width of the GTU type that can drive on
* this Lane? E.g., for a Tram or Train, a 5 cm deviation is a problem; for a Car or a Bicycle, more deviation is
* acceptable.
*/
/** Lateral alignment margin for longitudinally connected Lanes. */
public static final Length MARGIN = new Length(0.5, LengthUnit.METER);
/**
* NextLanes returns the successor lane(s) in the design line direction, if any exist.<br>
* The next lane(s) are cached, as it is too expensive to make the calculation every time. There are several possibilities:
* (1) Returning an empty set when there is no successor lane in the design direction or there is no longitudinal transfer
* possible to a successor lane in the design direction. (2) Returning a set with just one lane if the lateral position of
* the successor lane matches the lateral position of this lane (based on an overlap of the lateral positions of the two
* joining lanes of more than a certain percentage). (3) Multiple lanes in case the Node where the underlying Link for this
* Lane has multiple "outgoing" Links, and there are multiple lanes that match the lateral position of this lane.<br>
* The next lanes can differ per GTU type. For instance, a lane where cars and buses are allowed can have a next lane where
* only buses are allowed, forcing the cars to leave that lane.
* @param gtuType the GTU type for which we return the next lanes, use {@code null} to return all next lanes and their
* design direction
* @return set of Lanes following this lane for the given GTU type.
*/
// TODO this should return something immutable
public final Set<Lane> nextLanes(final GtuType gtuType)
{
if (!this.nextLanes.containsKey(gtuType))
{
// TODO determine if this should synchronize on this.nextLanes
Set<Lane> laneSet = new LinkedHashSet<>(1);
this.nextLanes.put(gtuType, laneSet);
if (gtuType == null)
{
// Construct (and cache) the result.
for (Link link : getLink().getEndNode().getLinks())
{
if (!(link.equals(this.getLink())) && link instanceof CrossSectionLink)
{
for (CrossSectionElement cse : ((CrossSectionLink) link).getCrossSectionElementList())
{
if (cse instanceof Lane)
{
Lane lane = (Lane) cse;
double jumpToStart = this.getCenterLine().getLast().distance(lane.getCenterLine().getFirst());
double jumpToEnd = this.getCenterLine().getLast().distance(lane.getCenterLine().getLast());
if (jumpToStart < MARGIN.si && jumpToStart < jumpToEnd
&& link.getStartNode().equals(getLink().getEndNode()))
{
// TODO And is it aligned with its next lane?
laneSet.add(lane);
}
// else: not a "connected" lane
}
}
}
}
}
else
{
nextLanes(null).stream().filter((lane) -> lane.getType().isCompatible(gtuType))
.forEach((lane) -> laneSet.add(lane));
}
}
return this.nextLanes.get(gtuType);
}
/**
* Forces the next lanes to be as specified. For specific GTU types, a subset of these lanes is taken.
* @param lanes Set<Lane>; lanes to set as next lanes.
*/
public void forceNextLanes(final Set<Lane> lanes)
{
Throw.whenNull(lanes, "Lanes should not be null. Use an empty set instead.");
this.nextLanes.clear();
this.nextLanes.put(null, lanes);
}
/**
* PrevLanes returns the predecessor lane(s) relative to the design line direction, if any exist.<br>
* The previous lane(s) are cached, as it is too expensive to make the calculation every time. There are several
* possibilities: (1) Returning an empty set when there is no predecessor lane relative to the design direction or there is
* no longitudinal transfer possible to a predecessor lane relative to the design direction. (2) Returning a set with just
* one lane if the lateral position of the predecessor lane matches the lateral position of this lane (based on an overlap
* of the lateral positions of the two joining lanes of more than a certain percentage). (3) Multiple lanes in case the Node
* where the underlying Link for this Lane has multiple "incoming" Links, and there are multiple lanes that match the
* lateral position of this lane.<br>
* The previous lanes can differ per GTU type. For instance, a lane where cars and buses are allowed can be preceded by a
* lane where only buses are allowed.
* @param gtuType the GTU type for which we return the next lanes, use {@code null} to return all prev lanes and their
* design direction
* @return set of Lanes following this lane for the given GTU type.
*/
// TODO this should return something immutable
public final Set<Lane> prevLanes(final GtuType gtuType)
{
if (!this.prevLanes.containsKey(gtuType))
{
Set<Lane> laneSet = new LinkedHashSet<>(1);
this.prevLanes.put(gtuType, laneSet);
// Construct (and cache) the result.
if (gtuType == null)
{
for (Link link : getLink().getStartNode().getLinks())
{
if (!(link.equals(this.getLink())) && link instanceof CrossSectionLink)
{
for (CrossSectionElement cse : ((CrossSectionLink) link).getCrossSectionElementList())
{
if (cse instanceof Lane)
{
Lane lane = (Lane) cse;
double jumpToStart = this.getCenterLine().getFirst().distance(lane.getCenterLine().getFirst());
double jumpToEnd = this.getCenterLine().getFirst().distance(lane.getCenterLine().getLast());
if (jumpToEnd < MARGIN.si && jumpToEnd < jumpToStart
&& link.getEndNode().equals(getLink().getStartNode()))
{
// TODO And is it aligned with its next lane?
laneSet.add(lane);
}
// else: not a "connected" lane
}
}
}
}
}
else
{
prevLanes(null).stream().filter((lane) -> lane.getType().isCompatible(gtuType))
.forEach((lane) -> laneSet.add(lane));
}
}
return this.prevLanes.get(gtuType);
}
/**
* Forces the previous lanes to be as specified. For specific GTU types, a subset of these lanes is taken.
* @param lanes Set<Lane>; lanes to set as previous lanes.
*/
public void forcePrevLanes(final Set<Lane> lanes)
{
Throw.whenNull(lanes, "Lanes should not be null. Use an empty set instead.");
this.prevLanes.clear();
this.prevLanes.put(null, lanes);
}
/**
* Determine the set of lanes to the left or to the right of this lane, which are accessible from this lane, or an empty set
* if no lane could be found. The method ignores all legal restrictions such as allowable directions and stripes.<br>
* A lane is called adjacent to another lane if the lateral edges are not more than a delta distance apart. This means that
* a lane that <i>overlaps</i> with another lane is <b>not</b> returned as an adjacent lane. <br>
* <b>Note:</b> LEFT and RIGHT are seen from the direction of the GTU, in its forward driving direction. <br>
* @param lateralDirection LateralDirectionality; LEFT or RIGHT.
* @param gtuType GtuType; the type of GTU for which to return the adjacent lanes.
* @return the set of lanes that are accessible, or null if there is no lane that is accessible with a matching driving
* direction.
*/
public final Set<Lane> accessibleAdjacentLanesPhysical(final LateralDirectionality lateralDirection, final GtuType gtuType)
{
return neighbors(lateralDirection, gtuType, false);
}
/**
* Determine the set of lanes to the left or to the right of this lane, which are accessible from this lane, or an empty set
* if no lane could be found. The method takes the LongitidinalDirectionality of the lane into account. In other words, if
* we drive in the DIR_PLUS direction and look for a lane on the LEFT, and there is a lane but the Directionality of that
* lane is not DIR_PLUS or DIR_BOTH, it will not be included.<br>
* A lane is called adjacent to another lane if the lateral edges are not more than a delta distance apart. This means that
* a lane that <i>overlaps</i> with another lane is <b>not</b> returned as an adjacent lane. <br>
* <b>Note:</b> LEFT and RIGHT are seen from the direction of the GTU, in its forward driving direction. <br>
* @param lateralDirection LateralDirectionality; LEFT or RIGHT.
* @param gtuType GtuType; the type of GTU for which to return the adjacent lanes.
* @return the set of lanes that are accessible, or null if there is no lane that is accessible with a matching driving
* direction.
*/
public final Set<Lane> accessibleAdjacentLanesLegal(final LateralDirectionality lateralDirection, final GtuType gtuType)
{
Set<Lane> candidates = new LinkedHashSet<>(1);
for (Lane lane : neighbors(lateralDirection, gtuType, true))
{
if (lane.getType().isCompatible(gtuType))
{
candidates.add(lane);
}
}
return candidates;
}
/**
* Returns one adjacent lane.
* @param laneChangeDirection LateralDirectionality; lane change direction
* @param gtuType GtuType; GTU type.
* @return Lane; adjacent lane, {@code null} if none
*/
public Lane getAdjacentLane(final LateralDirectionality laneChangeDirection, final GtuType gtuType)
{
Set<Lane> adjLanes = accessibleAdjacentLanesLegal(laneChangeDirection, gtuType);
if (!adjLanes.isEmpty())
{
return adjLanes.iterator().next();
}
return null;
}
/**
* Get the speed limit of this lane, which can differ per GTU type. E.g., cars might be allowed to drive 120 km/h and trucks
* 90 km/h.
* @param gtuType GtuType; the GTU type to provide the speed limit for
* @return the speedLimit.
* @throws NetworkException on network inconsistency
*/
public Speed getSpeedLimit(final GtuType gtuType) throws NetworkException
{
Speed speedLimit = this.cachedSpeedLimits.get(gtuType);
if (speedLimit == null)
{
if (this.speedLimitMap.containsKey(gtuType))
{
speedLimit = this.speedLimitMap.get(gtuType);
}
else if (gtuType.getParent() != null)
{
speedLimit = getSpeedLimit(gtuType.getParent());
}
else
{
throw new NetworkException("No speed limit set for GtuType " + gtuType + " on lane " + toString());
}
this.cachedSpeedLimits.put(gtuType, speedLimit);
}
return speedLimit;
}
/**
* Get the lowest speed limit of this lane.
* @return the lowest speedLimit.
* @throws NetworkException on network inconsistency
*/
public final Speed getLowestSpeedLimit() throws NetworkException
{
Throw.when(this.speedLimitMap.isEmpty(), NetworkException.class, "Lane %s has no speed limits set.", toString());
Speed out = Speed.POSITIVE_INFINITY;
for (GtuType gtuType : this.speedLimitMap.keySet())
{
out = Speed.min(out, this.speedLimitMap.get(gtuType));
}
return out;
}
/**
* Get the highest speed limit of this lane.
* @return the highest speedLimit.
* @throws NetworkException on network inconsistency
*/
public final Speed getHighestSpeedLimit() throws NetworkException
{
Throw.when(this.speedLimitMap.isEmpty(), NetworkException.class, "Lane %s has no speed limits set.", toString());
Speed out = Speed.ZERO;
for (GtuType gtuType : this.speedLimitMap.keySet())
{
out = Speed.max(out, this.speedLimitMap.get(gtuType));
}
return out;
}
/**
* Set the speed limit of this lane, which can differ per GTU type. Cars might be allowed to drive 120 km/h and trucks 90
* km/h. If the speed limit is the same for all GTU types, GtuType.ALL will be used. This means that the settings can be
* used additive, or subtractive. <br>
* In <b>additive use</b>, do not set the speed limit for GtuType.ALL. Now, one by one, the allowed maximum speeds for each
* of the GTU Types have be added. Do this when there are few GTU types or the speed limits per TU type are very different.
* <br>
* In <b>subtractive use</b>, set the speed limit for GtuType.ALL to the most common one. Override the speed limit for
* certain GtuTypes to a different value. An example is a lane on a highway where all vehicles, except truck (CAR, BUS,
* MOTORCYCLE, etc.), can drive 120 km/h, but trucks are allowed only 90 km/h. In that case, set the speed limit for
* GtuType.ALL to 120 km/h, and for TRUCK to 90 km/h.
* @param gtuType GtuType; the GTU type to provide the speed limit for
* @param speedLimit Speed; the speed limit for this gtu type
*/
public final void setSpeedLimit(final GtuType gtuType, final Speed speedLimit)
{
this.speedLimitMap.put(gtuType, speedLimit);
this.cachedSpeedLimits.clear();
}
/**
* Remove the set speed limit for a GtuType. If the speed limit for GtuType.ALL will be removed, there will not be a
* 'default' speed limit anymore. If the speed limit for a certain GtuType is removed, its speed limit will default to the
* speed limit of GtuType.ALL. <br>
* <b>Note</b>: if no speed limit is known for a GtuType, getSpeedLimit will throw a NetworkException when the speed limit
* is retrieved for that GtuType.
* @param gtuType GtuType; the GTU type to provide the speed limit for
*/
public final void removeSpeedLimit(final GtuType gtuType)
{
this.speedLimitMap.remove(gtuType);
this.cachedSpeedLimits.clear();
}
/** {@inheritDoc} */
@Override
public final LaneType getType()
{
return this.laneType;
}
/**
* @return gtuList.
*/
public final ImmutableList<LaneBasedGtu> getGtuList()
{
// TODO let HistoricalArrayList return an Immutable (WRAP) of itself
return this.gtuList == null ? new ImmutableArrayList<>(new ArrayList<>())
: new ImmutableArrayList<>(this.gtuList, Immutable.COPY);
}
/**
* Returns the list of GTU's at the specified time.
* @param time Time; time
* @return list of GTU's at the specified times
*/
public final List<LaneBasedGtu> getGtuList(final Time time)
{
if (time.equals(this.gtuListTime))
{
return this.gtuListAtTime;
}
this.gtuListTime = time;
this.gtuListAtTime = this.gtuList == null ? new ArrayList<>() : this.gtuList.get(time);
return this.gtuListAtTime;
}
/**
* Returns the number of GTU's.
* @return int; number of GTU's.
*/
public final int numberOfGtus()
{
return this.gtuList.size();
}
/**
* Returns the number of GTU's at specified time.
* @param time Time; time
* @return int; number of GTU's.
*/
public final int numberOfGtus(final Time time)
{
return getGtuList(time).size();
}
/**
* Returns the index of the given GTU, or -1 if not present.
* @param gtu LaneBasedGtu; gtu to get the index of
* @return int; index of the given GTU, or -1 if not present
*/
public final int indexOfGtu(final LaneBasedGtu gtu)
{
return Collections.binarySearch(this.gtuList, gtu, (gtu1, gtu2) ->
{
try
{
return gtu1.position(this, gtu1.getReference()).compareTo(gtu2.position(this, gtu2.getReference()));
}
catch (GtuException exception)
{
throw new RuntimeException(exception);
}
});
}
/**
* Returns the index of the given GTU, or -1 if not present, at specified time.
* @param gtu LaneBasedGtu; gtu to get the index of
* @param time Time; time
* @return int; index of the given GTU, or -1 if not present
*/
public final int indexOfGtu(final LaneBasedGtu gtu, final Time time)
{
return Collections.binarySearch(getGtuList(time), gtu, (gtu1, gtu2) ->
{
try
{
return Double.compare(gtu1.fractionalPosition(this, gtu1.getReference(), time),
gtu2.fractionalPosition(this, gtu2.getReference(), time));
}
catch (GtuException exception)
{
throw new RuntimeException(exception);
}
});
}
/**
* Returns the index'th GTU.
* @param index int; index of the GTU
* @return LaneBasedGtu; the index'th GTU
*/
public final LaneBasedGtu getGtu(final int index)
{
return this.gtuList.get(index);
}
/**
* Returns the index'th GTU at specified time.
* @param index int; index of the GTU
* @param time Time; time
* @return LaneBasedGtu; the index'th GTU
*/
public final LaneBasedGtu getGtu(final int index, final Time time)
{
return getGtuList(time).get(index);
}
/**
* Returns the covered distance driven to the given fractional position.
* @param fraction double; fractional position
* @return Length; covered distance driven to the given fractional position
*/
public final Length coveredDistance(final double fraction)
{
return getLength().times(fraction);
}
/**
* Returns the remaining distance to be driven from the given fractional position.
* @param fraction double; fractional position
* @return Length; remaining distance to be driven from the given fractional position
*/
public final Length remainingDistance(final double fraction)
{
return getLength().times(1.0 - fraction);
}
/**
* Returns the fraction along the design line for having covered the given distance.
* @param distance Length; covered distance
* @return double; fraction along the design line for having covered the given distance
*/
@Deprecated
public final double fractionAtCoveredDistance(final Length distance)
{
return fraction(distance);
}
/** {@inheritDoc} */
@Override
public final String toString()
{
CrossSectionLink link = getLink();
return String.format("Lane %s of %s", getId(), link.getId());
}
/** Cache of the hashCode. */
private Integer cachedHashCode = null;
/** {@inheritDoc} */
@SuppressWarnings("checkstyle:designforextension")
@Override
public int hashCode()
{
if (this.cachedHashCode == null)
{
final int prime = 31;
int result = super.hashCode();
result = prime * result + ((this.laneType == null) ? 0 : this.laneType.hashCode());
this.cachedHashCode = result;
}
return this.cachedHashCode;
}
/** {@inheritDoc} */
@SuppressWarnings({"checkstyle:designforextension", "checkstyle:needbraces"})
@Override
public boolean equals(final Object obj)
{
if (this == obj)
return true;
if (!super.equals(obj))
return false;
if (getClass() != obj.getClass())
return false;
Lane other = (Lane) obj;
if (this.laneType == null)
{
if (other.laneType != null)
return false;
}
else if (!this.laneType.equals(other.laneType))
return false;
return true;
}
/**
* Functional interface that can be used for line searches of objects on the lane.
* <p>
* Copyright (c) 2013-2024 Delft University of Technology, PO Box 5, 2600 AA, Delft, the Netherlands. All rights reserved.
* <br>
* BSD-style license. See <a href="https://opentrafficsim.org/docs/license.html">OpenTrafficSim License</a>.
* </p>
* @author <a href="https://github.com/averbraeck">Alexander Verbraeck</a>
* @author <a href="https://tudelft.nl/staff/p.knoppers-1">Peter Knoppers</a>
* @author <a href="https://github.com/wjschakel">Wouter Schakel</a>
*/
private interface Positions
{
/**
* Returns the position of the index'th element.
* @param index int; index
* @return double; position of the index'th element
* @throws GtuException on exception
*/
double get(int index) throws GtuException;
}
}