46 #ifdef CHECK_MEMORY_LEAKS
48 #endif // CHECK_MEMORY_LEAKS
61 #ifndef HAVE_INTERNAL_LANES
66 myLastStateChange(-1),
77 myLastStateChange(-1),
82 myJunctionInlane(via),
83 myInternalLaneBefore(0),
94 const std::vector<MSLink*>& foeLinks,
95 const std::vector<MSLane*>& foeLanes,
96 MSLane* internalLaneBefore) {
101 for (std::vector<MSLane*>::const_iterator it_lane = foeLanes.begin(); it_lane != foeLanes.end(); ++it_lane) {
106 #ifdef HAVE_INTERNAL_LANES
107 myInternalLaneBefore = internalLaneBefore;
109 if (internalLaneBefore != 0) {
111 lane = internalLaneBefore;
117 #ifdef MSLink_DEBUG_CROSSING_POINTS
121 const bool beforeInternalJunction = lane->
getLinkCont()[0]->getViaLaneOrLane()->getEdge().isInternal();
124 for (std::vector<const MSLane*>::const_iterator it_lane =
myFoeLanes.begin(); it_lane !=
myFoeLanes.end(); ++it_lane) {
126 if (sameTarget && !beforeInternalJunction) {
129 myLengthsBehindCrossing.push_back(std::make_pair(0, 0));
130 #ifdef MSLink_DEBUG_CROSSING_POINTS
132 <<
" " << lane->
getID()
133 <<
" merges with " << (*it_lane)->getID()
134 <<
" nextLane " << lane->
getLinkCont()[0]->getViaLaneOrLane()->getID()
135 <<
" dist1=" << myLengthsBehindCrossing.back().first
136 <<
" dist2=" << myLengthsBehindCrossing.back().second
141 #ifdef MSLink_DEBUG_CROSSING_POINTS
144 bool haveIntersection =
true;
145 if (intersections1.size() == 0) {
146 intersections1.push_back(-10000.0);
147 haveIntersection =
false;
148 }
else if (intersections1.size() > 1) {
149 std::sort(intersections1.begin(), intersections1.end());
151 std::vector<SUMOReal> intersections2 = (*it_lane)->getShape().intersectsAtLengths2D(lane->
getShape());
152 #ifdef MSLink_DEBUG_CROSSING_POINTS
155 if (intersections2.size() == 0) {
156 intersections2.push_back(0);
157 }
else if (intersections2.size() > 1) {
158 std::sort(intersections2.begin(), intersections2.end());
160 if (haveIntersection) {
162 intersections1.back() -= (*it_lane)->getWidth() / 2;
163 intersections2.back() -= lane->
getWidth() / 2;
166 intersections2.back() = (*it_lane)->interpolateGeometryPosToLanePos(intersections2.back());
171 intersections1.back() = 0;
175 myLengthsBehindCrossing.push_back(std::make_pair(
176 lane->
getLength() - intersections1.back(),
177 (*it_lane)->getLength() - intersections2.back()));
179 #ifdef MSLink_DEBUG_CROSSING_POINTS
181 <<
" intersection of " << lane->
getID()
183 <<
" with " << (*it_lane)->getID()
184 <<
" totalLength=" << (*it_lane)->getLength()
185 <<
" dist1=" << myLengthsBehindCrossing.back().first
186 <<
" dist2=" << myLengthsBehindCrossing.back().second
196 for (MSLinkCont::const_iterator it = predLinks.begin(); it != predLinks.end(); ++it) {
197 const MSLane* sibling = (*it)->getViaLane();
198 if (sibling != lane && sibling != 0) {
200 #ifdef MSLink_DEBUG_CROSSING_POINTS
203 if (intersections1.size() > 0) {
204 std::sort(intersections1.begin(), intersections1.end());
207 myLengthsBehindCrossing.push_back(std::make_pair(
208 lane->
getLength() - intersections1.back(),
209 sibling->
getLength() - intersections1.back()));
211 #ifdef MSLink_DEBUG_CROSSING_POINTS
212 std::cout <<
" adding same-origin foe" << sibling->
getID()
213 <<
" dist1=" << myLengthsBehindCrossing.back().first
214 <<
" dist2=" << myLengthsBehindCrossing.back().second
228 std::pair<SUMOReal, SUMOReal>
233 const bool setRequest,
const SUMOTime arrivalTimeBraking,
const SUMOReal arrivalSpeedBraking,
const SUMOTime waitingTime) {
237 arrivalTimeBraking, arrivalSpeedBraking, waitingTime)));
251 if ((*i)->isBlockingAnyone()) {
267 std::map<const SUMOVehicle*, ApproachingVehicleInformation>::const_iterator i =
myApproachingVehicles.find(veh);
286 std::vector<const SUMOVehicle*>* collectFoes)
const {
300 if ((*i)->haveRed()) {
305 if ((*i)->blockedAtTime(arrivalTime, leaveTime, arrivalSpeed, leaveSpeed,
myLane == (*i)->getLane(),
306 impatience, decel, waitingTime, collectFoes)) {
317 std::vector<const SUMOVehicle*>* collectFoes)
const {
319 if (!i->second.willPass) {
323 assert(waitingTime > 0);
324 if (waitingTime > i->second.waitingTime) {
327 if (waitingTime == i->second.waitingTime && arrivalTime < i->second.arrivalTime) {
331 const SUMOTime foeArrivalTime = (
SUMOTime)((1.0 - impatience) * i->second.arrivalTime + impatience * i->second.arrivalTimeBraking);
332 if (i->second.leavingTime < arrivalTime) {
334 if (sameTargetLane && (arrivalTime - i->second.leavingTime <
myLookaheadTime
336 i->first->getVehicleType().getCarFollowModel().getMaxDecel(), decel))) {
337 if (collectFoes == 0) {
340 collectFoes->push_back(i->first);
343 }
else if (foeArrivalTime > leaveTime) {
347 decel, i->first->getVehicleType().getCarFollowModel().getMaxDecel()))) {
348 if (collectFoes == 0) {
351 collectFoes->push_back(i->first);
356 if (collectFoes == 0) {
359 collectFoes->push_back(i->first);
380 assert(distLeft > 0);
391 if ((*i)->blockedAtTime(arrivalTime, leaveTime, speed, speed,
myLane == (*i)->getLane(), 0, decel, 0)) {
395 for (std::vector<const MSLane*>::const_iterator i =
myFoeLanes.begin(); i !=
myFoeLanes.end(); ++i) {
396 if ((*i)->getVehicleNumber() > 0 || (*i)->getPartialOccupator() != 0) {
427 #ifdef HAVE_INTERNAL_LANES
428 if (myJunctionInlane != 0) {
429 approachedLane = myJunctionInlane;
436 const std::vector<MSLane::IncomingLaneInfo> possibleLanes = approachedLane->
getIncomingLanes();
437 std::vector<MSLane::IncomingLaneInfo>::const_iterator i;
438 for (i = possibleLanes.begin(); i != possibleLanes.end(); i++) {
441 for (MSLinkCont::const_iterator j = outgoingLinks.begin(); j != outgoingLinks.end(); j++) {
454 #ifdef HAVE_INTERNAL_LANES
455 if (myJunctionInlane == 0 ||
myAmCont) {
465 assert(predLink != 0);
480 #ifdef HAVE_INTERNAL_LANES
481 const std::string via = getViaLane() == 0 ?
"" : getViaLane()->getID();
483 const std::string via =
"";
487 std::vector<std::pair<SUMOTime, const SUMOVehicle*> > toSort;
489 toSort.push_back(std::make_pair(it->second.arrivalTime, it->first));
491 std::sort(toSort.begin(), toSort.end());
492 for (std::vector<std::pair<SUMOTime, const SUMOVehicle*> >::const_iterator it = toSort.begin(); it != toSort.end(); ++it) {
511 #ifdef HAVE_INTERNAL_LANES
513 MSLink::getViaLane()
const {
514 return myJunctionInlane;
519 MSLink::getLeaderInfo(
SUMOReal dist,
SUMOReal minGap, std::vector<const MSPerson*>* collectBlockers)
const {
525 || (myJunctionInlane != 0 && myJunctionInlane->getLogicalPredecessorLane()->getEdge().isInternal()))) {
528 for (
size_t i = 0; i <
myFoeLanes.size(); ++i) {
531 const SUMOReal distToCrossing = dist - myLengthsBehindCrossing[i].first;
533 const bool sameSource = (myInternalLaneBefore != 0 && myInternalLaneBefore->getLogicalPredecessorLane() == foeLane->
getLogicalPredecessorLane());
534 const SUMOReal crossingWidth = (sameTarget || sameSource) ? 0 : foeLane->
getWidth();
535 const SUMOReal foeCrossingWidth = (sameTarget || sameSource) ? 0 : myInternalLaneBefore->getWidth();
537 if (distToCrossing + crossingWidth < 0) {
540 const SUMOReal foeDistToCrossing = foeLane->
getLength() - myLengthsBehindCrossing[i].second;
548 const bool cannotIgnore = contLane || sameTarget || sameSource;
551 for (MSLane::VehCont::const_iterator it_veh = vehicles.begin(); it_veh != vehicles.end(); ++it_veh) {
553 if (!cannotIgnore && !foeLane->
getLinkCont()[0]->getApproaching(leader).willPass) {
560 if (contLane && !sameSource) {
564 const SUMOReal leaderBackDist = foeDistToCrossing - leaderBack;
566 if (leaderBackDist + foeCrossingWidth < 0) {
571 gap = distToCrossing - leaderBackDist - (sameTarget ? minGap : 0);
573 result.push_back(LinkLeader(leader, gap, cannotIgnore ? -1 : distToCrossing));
583 if (contLane && !sameSource) {
588 if (leaderBackDist + foeCrossingWidth < 0) {
593 gap = distToCrossing - leaderBackDist - (sameTarget ? minGap : 0);
595 result.push_back(LinkLeader(leader, gap, sameTarget ? -1 : distToCrossing));
600 if (distToPeds >= -MSPModel::SAFETY_GAP &&
MSPModel::getModel()->blockedAtDist(foeLane, foeDistToCrossing, collectBlockers)) {
601 result.push_back(LinkLeader((
MSVehicle*)0, -1, distToPeds));
612 #ifdef HAVE_INTERNAL_LANES
613 if (myJunctionInlane != 0) {
614 return myJunctionInlane;
const MSJunction * myJunction
the junction to which this link belongs
OutputDevice & writeAttr(const SumoXMLAttr attr, const T &val)
writes a named attribute
MSEdge & getEdge() const
Returns the lane's edge.
int myIndex
The position within this respond.
Representation of a vehicle in the micro simulation.
bool hasFoes() const
Returns whether this link belongs to a junction where more than one edge is incoming.
bool hasApproachingFoe(SUMOTime arrivalTime, SUMOTime leaveTime, SUMOReal speed, SUMOReal decel) const
Returns the information whether a vehicle is approaching on one of the link's foe streams...
static const SUMOReal SAFETY_GAP
MSLane * myLane
The lane (but the internal one) approached by this link.
void addBlockedLink(MSLink *link)
ApproachingVehicleInformation getApproaching(const SUMOVehicle *veh) const
LinkState myState
The state of the link.
virtual void releaseVehicles() const
Allows to use the container for microsimulation again.
const MSCFModel & getCarFollowModel() const
Returns the vehicle's car following model definition.
std::pair< SUMOReal, SUMOReal > getLastIntersections(const MSLane *lane, const MSLane *foe)
void setRequestInformation(int index, bool hasFoes, bool isCont, const std::vector< MSLink * > &foeLinks, const std::vector< MSLane * > &foeLanes, MSLane *internalLaneBefore=0)
Sets the request information.
SUMOTime getWaitingTime() const
Returns the SUMOTime waited (speed was lesser than 0.1m/s)
bool myHasFoes
Whether any foe links exist.
This is an uncontrolled, minor link, has to stop.
SUMOReal getLength() const
Returns the lane's length.
SUMOTime myLastStateChange
The time of the last state change.
std::vector< MSLink * > myFoeLinks
void setTLState(LinkState state, SUMOTime t)
Sets the current tl-state.
std::vector< MSVehicle * > VehCont
Container for vehicles.
std::string time2string(SUMOTime t)
SUMOReal getLength() const
Get vehicle's length [m].
LinkDirection myDirection
An abstract (hopefully human readable) definition of the link's direction.
SUMOReal getWidth() const
Returns the lane's width.
LinkDirection getDirection() const
Returns the direction the vehicle passing this link take.
SUMOReal getPositionOnLane() const
Get the vehicle's position along the lane.
std::map< const SUMOVehicle *, ApproachingVehicleInformation > myApproachingVehicles
bool lastWasContMajor() const
whether this is a link past an internal junction which currently has priority
This is an uncontrolled, all-way stop link.
#define UNUSED_PARAMETER(x)
#define WRITE_WARNING(msg)
bool blockedAtTime(SUMOTime arrivalTime, SUMOTime leaveTime, SUMOReal arrivalSpeed, SUMOReal leaveSpeed, bool sameTargetLane, SUMOReal impatience, SUMOReal decel, SUMOTime waitingTime, std::vector< const SUMOVehicle * > *collectFoes=0) const
Returns the information whether this link is blocked Valid after the vehicles have set their requests...
virtual const VehCont & getVehiclesSecure() const
Returns the vehicles container; locks it for microsimulation.
SUMOReal getPartialOccupatorEnd() const
Returns the position of the in-lapping vehicle's end.
LinkDirection
The different directions a link between two lanes may take (or a stream between two edges)...
int getIndex() const
Returns the respond index (for visualization)
SUMOTime getLeaveTime(const SUMOTime arrivalTime, const SUMOReal arrivalSpeed, const SUMOReal leaveSpeed, const SUMOReal vehicleLength) const
return the expected time at which the given vehicle will clear the link
const std::string & getID() const
Returns the id.
MSLane * getLogicalPredecessorLane() const
Representation of a vehicle.
static MSPModel * getModel()
MSLane * getLane() const
Returns the connected lane.
std::set< MSLink * > myBlockedFoeLinks
LinkState
The right-of-way state of a link between two lanes used when constructing a NBTrafficLightLogic, in MSLink and GNEInternalLane.
std::vector< LinkLeader > LinkLeaders
static bool gUsingInternalLanes
Information whether the simulation regards internal lanes.
SUMOReal getMaxDecel() const
Get the vehicle type's maximum deceleration [m/s^2].
MSVehicle * getLastVehicle() const
returns the last vehicle
std::string toString(const T &t, std::streamsize accuracy=OUTPUT_ACCURACY)
bool isInternal() const
return whether this edge is an internal edge
static bool unsafeMergeSpeeds(SUMOReal leaderSpeed, SUMOReal followerSpeed, SUMOReal leaderDecel, SUMOReal followerDecel)
return whether the given vehicles may NOT merge safely
SUMOReal getLength() const
Returns the length of this link.
static bool maybeOccupied(MSLane *lane)
returns whether the given lane may still be occupied by a vehicle currently on it ...
EdgeBasicFunction getPurpose() const
Returns the edge type (EdgeBasicFunction)
MSLane * getApproachingLane() const
Returns the lane leading to this link.
bool havePriority() const
Returns whether this link is a major link.
bool willHaveBlockedFoe() const
static MSLink * getConnectingLink(const MSLane &from, const MSLane &to)
Returns the link connecting both lanes Both lanes have to be non-internal; 0 may be returned if no co...
The edge is a normal street.
MSLane * getViaLaneOrLane() const
return the via lane if it exists and the lane otherwise
const MSVehicleType & getVehicleType() const
Returns the vehicle's type definition.
bool haveRed() const
Returns whether this link is blocked by a red (or redyellow) traffic light.
SUMOReal getSpeed() const
Returns the vehicle's current speed.
void writeApproaching(OutputDevice &od, const std::string fromLaneID) const
write information about all approaching vehicles to the given output device
static SUMOTime gIgnoreJunctionBlocker
Information whether the simulation regards internal lanes.
const PositionVector & getShape() const
Returns this lane's shape.
MSLink(MSLane *succLane, LinkDirection dir, LinkState state, SUMOReal length)
Constructor for simulation not using internal lanes.
MSVehicle * getPartialOccupator() const
Returns the vehicle which laps into this lane.
Static storage of an output device and its base (abstract) implementation.
bool closeTag()
Closes the most recently opened tag.
static const bool gUseMesoSim
void setApproaching(const SUMOVehicle *approaching, const SUMOTime arrivalTime, const SUMOReal arrivalSpeed, const SUMOReal leaveSpeed, const bool setRequest, const SUMOTime arrivalTimeBraking, const SUMOReal arrivalSpeedBraking, const SUMOTime waitingTime)
Sets the information about an approaching vehicle.
const MSJunction * getFromJunction() const
void removeApproaching(const SUMOVehicle *veh)
removes the vehicle from myApproachingVehicles
const MSLinkCont & getLinkCont() const
returns the container with all links !!!
const std::vector< IncomingLaneInfo > & getIncomingLanes() const
The edge is an internal edge.
SUMOReal interpolateGeometryPosToLanePos(SUMOReal geometryPos) const
std::vector< SUMOReal > intersectsAtLengths2D(const PositionVector &other) const
For all intersections between this vector and other, return the 2D-length of the subvector from this ...
static SUMOTime myLookaheadTime
Representation of a lane in the micro simulation.
bool opened(SUMOTime arrivalTime, SUMOReal arrivalSpeed, SUMOReal leaveSpeed, SUMOReal vehicleLength, SUMOReal impatience, SUMOReal decel, SUMOTime waitingTime, std::vector< const SUMOVehicle * > *collectFoes=0) const
Returns the information whether the link may be passed.
OutputDevice & openTag(const std::string &xmlElement)
Opens an XML tag.
std::vector< const MSLane * > myFoeLanes
virtual const MSVehicleType & getVehicleType() const =0
Returns the vehicle's type.