Eclipse SUMO - Simulation of Urban MObility
All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Properties Friends Macros Modules Pages
NBNodeCont.cpp
Go to the documentation of this file.
1/****************************************************************************/
2// Eclipse SUMO, Simulation of Urban MObility; see https://eclipse.dev/sumo
3// Copyright (C) 2001-2025 German Aerospace Center (DLR) and others.
4// This program and the accompanying materials are made available under the
5// terms of the Eclipse Public License 2.0 which is available at
6// https://www.eclipse.org/legal/epl-2.0/
7// This Source Code may also be made available under the following Secondary
8// Licenses when the conditions for such availability set forth in the Eclipse
9// Public License 2.0 are satisfied: GNU General Public License, version 2
10// or later which is available at
11// https://www.gnu.org/licenses/old-licenses/gpl-2.0-standalone.html
12// SPDX-License-Identifier: EPL-2.0 OR GPL-2.0-or-later
13/****************************************************************************/
24// Container for nodes during the netbuilding process
25/****************************************************************************/
26#include <config.h>
27
28#include <string>
29#include <map>
30#include <algorithm>
31#include <cmath>
33#include <utils/geom/Boundary.h>
46#include "NBHelpers.h"
47#include "NBAlgorithms.h"
48#include "NBDistrict.h"
49#include "NBEdgeCont.h"
51#include "NBOwnTLDef.h"
52#include "NBPTStop.h"
53#include "NBNodeCont.h"
54#include "NBPTStopCont.h"
55#include "NBPTLineCont.h"
56#include "NBParking.h"
57
58// ===========================================================================
59// Algorithm constants
60// ===========================================================================
61#define MAX_SLIPLANE_LENGTH 1000
62
63// ===========================================================================
64// Debug Flags
65// ===========================================================================
66
67//#define DEBUG_JOINJUNCTIONS
68//#define DEBUG_REDUCE
69//#define DEBUG_JOINJUNCTIONS_CONNECTIONS
70//#define DEBUG_GUESSSIGNALS
71#define DEBUGNODEID ""
72#define DEBUGNODEID2 ""
73//#define DEBUGNODEID "5548037023"
74#define DEBUGCOND(obj) ((obj) != 0 && ((obj)->getID() == DEBUGNODEID || (obj)->getID() == DEBUGNODEID2))
75//#define DEBUGCOND(obj) (true)
76
77
78// ===========================================================================
79// method definitions
80// ===========================================================================
84
85
86// ----------- Insertion/removal/retrieval of nodes
87bool
88NBNodeCont::insert(const std::string& id, const Position& position,
89 NBDistrict* district) {
90 NodeCont::iterator i = myNodes.find(id);
91 if (i != myNodes.end()) {
92 return false;
93 }
94 NBNode* node = new NBNode(id, position, district);
95 myNodes[id] = node;
96 const float pos[2] = {(float)position.x(), (float)position.y()};
97 myRTree.Insert(pos, pos, node);
98 return true;
99}
100
101
102bool
104 std::string id = node->getID();
105 NodeCont::iterator i = myNodes.find(id);
106 if (i != myNodes.end()) {
107 return false;
108 }
109 myNodes[id] = node;
110 const float pos[2] = {(float)node->getPosition().x(), (float)node->getPosition().y()};
111 myRTree.Insert(pos, pos, node);
112 return true;
113}
114
115
116NBNode*
117NBNodeCont::retrieve(const std::string& id) const {
118 NodeCont::const_iterator i = myNodes.find(id);
119 if (i == myNodes.end()) {
120 return nullptr;
121 }
122 return (*i).second;
123}
124
125
126NBNode*
127NBNodeCont::retrieve(const Position& position, const double offset) const {
128 const double extOffset = offset + POSITION_EPS;
129 const float cmin[2] = {(float)(position.x() - extOffset), (float)(position.y() - extOffset)};
130 const float cmax[2] = {(float)(position.x() + extOffset), (float)(position.y() + extOffset)};
131 std::set<const Named*> into;
132 Named::StoringVisitor sv(into);
133 myRTree.Search(cmin, cmax, sv);
134 for (const Named* namedNode : into) {
135 NBNode* node = const_cast<NBNode*>(dynamic_cast<const NBNode*>(namedNode));
136 if (fabs(node->getPosition().x() - position.x()) <= offset
137 &&
138 fabs(node->getPosition().y() - position.y()) <= offset) {
139 return node;
140 }
141 }
142 return nullptr;
143}
144
145
146bool
148 if (extract(node)) {
149 delete node;
150 return true;
151 } else {
152 return false;
153 }
154}
155
156
157bool
158NBNodeCont::extract(NBNode* node, bool remember) {
159 NodeCont::iterator i = myNodes.find(node->getID());
160 if (i == myNodes.end()) {
161 return false;
162 }
163 myNodes.erase(i);
164 const float pos[2] = {(float)node->getPosition().x(), (float)node->getPosition().y()};
165 myRTree.Remove(pos, pos, node);
166 node->removeTrafficLights();
167 if (remember) {
168 myExtractedNodes[node->getID()] = node;
169 }
170 return true;
171}
172
173
174// ----------- Adapting the input
175int
177 int no = 0;
178 for (NodeCont::iterator i = myNodes.begin(); i != myNodes.end(); i++) {
179 no += (*i).second->removeSelfLoops(dc, ec, tc);
180 }
181 if (no != 0) {
182 WRITE_WARNING(toString(no) + " self-looping edge(s) removed.");
183 }
184 return no;
185}
186
187
188void
190 // magic values
191 const double distanceThreshold = 7.; // don't merge edges further apart
192 const double lengthThreshold = 0.10; // don't merge edges with higher relative length-difference
193
194 for (NodeCont::iterator i = myNodes.begin(); i != myNodes.end(); i++) {
195 // count the edges to other nodes outgoing from the current node
196 std::map<NBNode*, EdgeVector> connectionCount;
197 const EdgeVector& outgoing = (*i).second->getOutgoingEdges();
198 for (EdgeVector::const_iterator j = outgoing.begin(); j != outgoing.end(); j++) {
199 connectionCount[(*j)->getToNode()].push_back(*j);
200 }
201 // check whether more than a single edge connect another node and join them
202 std::map<NBNode*, EdgeVector>::iterator k;
203 for (k = connectionCount.begin(); k != connectionCount.end(); k++) {
204 // possibly we do not have anything to join...
205 if ((*k).second.size() < 2) {
206 continue;
207 }
208 // for the edges that seem to be a single street,
209 // check whether the geometry is similar
210 const EdgeVector& ev = (*k).second;
211 const NBEdge* const first = ev.front();
212 EdgeVector::const_iterator jci; // join candidate iterator
213 for (jci = ev.begin() + 1; jci != ev.end(); ++jci) {
214 const double relativeLengthDifference = fabs(first->getLoadedLength() - (*jci)->getLoadedLength()) / first->getLoadedLength();
215 if ((!first->isNearEnough2BeJoined2(*jci, distanceThreshold)) ||
216 (relativeLengthDifference > lengthThreshold) ||
217 (fabs(first->getSpeed() - (*jci)->getSpeed()) >= 0.01) || // output accuracy
218 (first->getPermissions() != (*jci)->getPermissions())
219 ) {
220 break;
221 }
222 }
223 // @bug If there are 3 edges of which 2 can be joined, no joining will
224 // take place with the current implementation
225 if (jci == ev.end()) {
226 if (removeDuplicates) {
227 for (int ei = 1; ei < (int)ev.size(); ei++) {
228 ec.extract(dc, ev[ei], true);
229 }
230 } else {
231 ec.joinSameNodeConnectingEdges(dc, tlc, ev);
232 }
233 }
234 }
235 }
236}
237
238
239int
241 int numRemovedEdges = 0;
242 // Warn of isolated edges, i.e. a single edge with no connection to another edge
243 const std::vector<std::string>& edgeNames = ec.getAllNames();
244 for (std::vector<std::string>::const_iterator it = edgeNames.begin(); it != edgeNames.end(); ++it) {
245 // Test whether this node starts at a dead end, i.e. it has only one adjacent node
246 // to which an edge exists and from which an edge may come.
247 NBEdge* e = ec.retrieve(*it);
248 if (e == nullptr) {
249 continue;
250 }
251 NBNode* from = e->getFromNode();
252 const EdgeVector& outgoingEdges = from->getOutgoingEdges();
253 if (outgoingEdges.size() != 1) {
254 // At this node, several edges or no edge start; so, this node is no dead end.
255 continue;
256 }
257 const EdgeVector& incomingEdges = from->getIncomingEdges();
258 if (incomingEdges.size() > 1) {
259 // At this node, several edges end; so, this node is no dead end.
260 continue;
261 } else if (incomingEdges.size() == 1) {
262 NBNode* fromNodeOfIncomingEdge = incomingEdges[0]->getFromNode();
263 NBNode* toNodeOfOutgoingEdge = outgoingEdges[0]->getToNode();
264 if (fromNodeOfIncomingEdge != toNodeOfOutgoingEdge) {
265 // At this node, an edge ends which is not the inverse direction of
266 // the starting node.
267 continue;
268 }
269 }
270 // Now we know that the edge e starts a dead end.
271 // Next we test if the dead end is isolated, i.e. does not lead to a junction
272 bool hasJunction = false;
273 EdgeVector road;
274 NBEdge* eOld = nullptr;
275 NBNode* to;
276 NodeSet adjacentNodes;
277 do {
278 road.push_back(e);
279 eOld = e;
280 from = e->getFromNode();
281 to = e->getToNode();
282 const EdgeVector& outgoingEdgesOfToNode = to->getOutgoingEdges();
283 const EdgeVector& incomingEdgesOfToNode = to->getIncomingEdges();
284 adjacentNodes.clear();
285 for (EdgeVector::const_iterator itOfOutgoings = outgoingEdgesOfToNode.begin(); itOfOutgoings != outgoingEdgesOfToNode.end(); ++itOfOutgoings) {
286 if ((*itOfOutgoings)->getToNode() != from // The back path
287 && (*itOfOutgoings)->getToNode() != to // A loop / dummy edge
288 ) {
289 e = *itOfOutgoings; // Probably the next edge
290 }
291 adjacentNodes.insert((*itOfOutgoings)->getToNode());
292 }
293 for (EdgeVector::const_iterator itOfIncomings = incomingEdgesOfToNode.begin(); itOfIncomings != incomingEdgesOfToNode.end(); ++itOfIncomings) {
294 adjacentNodes.insert((*itOfIncomings)->getFromNode());
295 }
296 adjacentNodes.erase(to); // Omit loops
297 if (adjacentNodes.size() > 2) {
298 hasJunction = true;
299 }
300 } while (!hasJunction && eOld != e);
301 if (!hasJunction) {
302 std::string warningString;
303 for (EdgeVector::iterator roadIt = road.begin(); roadIt != road.end(); ++roadIt) {
304 if (roadIt == road.begin()) {
305 warningString += (*roadIt)->getID();
306 } else {
307 warningString += "," + (*roadIt)->getID();
308 }
309
310 NBNode* fromNode = (*roadIt)->getFromNode();
311 NBNode* toNode = (*roadIt)->getToNode();
312 ec.erase(dc, *roadIt);
313 numRemovedEdges++;
314 if (fromNode->getIncomingEdges().size() == 0 && fromNode->getOutgoingEdges().size() == 0) {
315 // Node is empty; can be removed
316 erase(fromNode);
317 }
318 if (toNode->getIncomingEdges().size() == 0 && toNode->getOutgoingEdges().size() == 0) {
319 // Node is empty; can be removed
320 erase(toNode);
321 }
322 }
323 WRITE_WARNINGF(TL("Removed a road without junctions: %."), warningString);
324 }
325 }
326 return numRemovedEdges;
327}
328
329
330int
331NBNodeCont::removeComponents(NBDistrictCont& dc, NBEdgeCont& ec, const int numKeep, bool hasPTStops) {
332 myRailComponents.clear();
333 std::vector<std::set<NBEdge*> > components;
334 // need to use ids here to have the same ordering on all platforms
335 std::set<std::string> edgesLeft;
336 for (std::map<std::string, NBEdge*>::const_iterator edgeIt = ec.begin(); edgeIt != ec.end(); ++edgeIt) {
337 edgesLeft.insert(edgeIt->first);
338 }
339 EdgeVector queue;
340 std::set<NBEdge*> toRemove;
341 int foundComponents = 0;
342 int numRemoved = 0;
343 while (!edgesLeft.empty()) {
344 queue.push_back(ec.getByID(*edgesLeft.begin()));
345 std::set<NBEdge*> component;
346 while (!queue.empty()) {
347 NBEdge* const e = queue.back();
348 queue.pop_back();
349 component.insert(e);
350 std::vector<EdgeVector> edgeLists;
351 edgeLists.push_back(e->getFromNode()->getOutgoingEdges());
352 edgeLists.push_back(e->getFromNode()->getIncomingEdges());
353 edgeLists.push_back(e->getToNode()->getOutgoingEdges());
354 edgeLists.push_back(e->getToNode()->getIncomingEdges());
355 for (std::vector<EdgeVector>::const_iterator listIt = edgeLists.begin(); listIt != edgeLists.end(); ++listIt) {
356 for (EdgeVector::const_iterator edgeIt = listIt->begin(); edgeIt != listIt->end(); ++edgeIt) {
357 std::set<std::string>::iterator leftIt = edgesLeft.find((*edgeIt)->getID());
358 if (leftIt != edgesLeft.end()) {
359 queue.push_back(*edgeIt);
360 edgesLeft.erase(leftIt);
361 }
362 }
363 }
364 }
365 foundComponents++;
366 std::vector<std::set<NBEdge*> >::iterator cIt;
367 for (cIt = components.begin(); cIt != components.end(); ++cIt) {
368 if (cIt->size() < component.size()) {
369 break;
370 }
371 }
372 components.insert(cIt, component);
373 if ((int)components.size() > numKeep) {
374 bool recheck = false;
375 if (hasPTStops) {
376 for (NBEdge* e : components.back()) {
377 SVCPermissions permissions = e->getPermissions();
378 if (isRailway(permissions) || isWaterway(permissions)) {
379 // recheck for connection to other components via access definitions
380 recheck = true;
381 break;
382 }
383 }
384 }
385 if (!recheck) {
386 toRemove.insert(components.back().begin(), components.back().end());
387 numRemoved++;
388 } else {
389 std::vector<std::string> edgeIDs;
390 for (NBEdge* e : components.back()) {
391 edgeIDs.push_back(e->getID());
392 }
393 myRailComponents.push_back(edgeIDs);
394 }
395 components.pop_back();
396 }
397 }
398 ec.removeRoundaboutEdges(toRemove);
399 for (NBEdge* e : toRemove) {
400 NBNode* const fromNode = e->getFromNode();
401 NBNode* const toNode = e->getToNode();
402 ec.erase(dc, e);
403 if (fromNode->getIncomingEdges().size() == 0 && fromNode->getOutgoingEdges().size() == 0) {
404 erase(fromNode);
405 }
406 if (toNode->getIncomingEdges().size() == 0 && toNode->getOutgoingEdges().size() == 0) {
407 erase(toNode);
408 }
409 }
410 if (foundComponents > 1) {
411 WRITE_MESSAGEF(TL("Found % components and removed % (% edges)."), toString(foundComponents), toString(numRemoved), toString(toRemove.size()));
412 }
413 return (int)toRemove.size();
414}
415
416
417int
419 std::set<std::string> stopEdges;
420 for (const auto& item : sc.getStops()) {
421 stopEdges.insert(item.second->getEdgeId());
422 }
423 int numRemoved = 0;
424 int numRemovedEdges = 0;
425 for (auto& component : myRailComponents) {
426 bool keep = false;
427 for (std::string edgeID : component) {
428 if (stopEdges.count(edgeID) != 0) {
429 keep = true;
430 break;
431 }
432 }
433 if (!keep) {
434 numRemoved++;
435 numRemovedEdges += (int)component.size();
436 for (std::string edgeID : component) {
437 NBEdge* e = ec.retrieve(edgeID);
438 if (e != nullptr) {
439 NBNode* const fromNode = e->getFromNode();
440 NBNode* const toNode = e->getToNode();
441 ec.erase(dc, e);
442 if (fromNode->getIncomingEdges().size() == 0 && fromNode->getOutgoingEdges().size() == 0) {
443 erase(fromNode);
444 }
445 if (toNode->getIncomingEdges().size() == 0 && toNode->getOutgoingEdges().size() == 0) {
446 erase(toNode);
447 }
448 }
449 }
450 }
451 }
452 if (numRemoved > 0) {
453 WRITE_MESSAGEF(TL("Removed % railway components (% edges)."), toString(numRemoved), toString(numRemovedEdges));
454 }
455 return numRemoved;
456}
457
458
459int
462 NBPTLineCont& lc,
463 NBParkingCont& pc,
464 bool removeGeometryNodes) {
465 // load edges that shall not be modified
466 std::set<std::string> edges2keep;
467 if (removeGeometryNodes) {
469 if (oc.isSet("geometry.remove.keep-edges.input-file")) {
470 NBHelpers::loadEdgesFromFile(oc.getString("geometry.remove.keep-edges.input-file"), edges2keep);
471 }
472 if (oc.isSet("geometry.remove.keep-edges.explicit")) {
473 const std::vector<std::string> edges = oc.getStringVector("geometry.remove.keep-edges.explicit");
474 edges2keep.insert(edges.begin(), edges.end());
475 }
476 // no need to keep pt stop edges, they are remapped later
477 // no need to keep all pt route edges. They are validated again before writing
478 pc.addEdges2Keep(oc, edges2keep);
479 if (oc.exists("geometry.remove.keep-ptstops") && oc.getBool("geometry.remove.keep-ptstops")) {
480 sc.addEdges2Keep(oc, edges2keep);
481 }
482 }
483
484 std::map<NBEdge*, std::set<NBTrafficLightDefinition*> > tlsLookup;
485 for (auto it = ec.begin(); it != ec.end(); it++) {
486 NBEdge* e = it->second;
487 NBNode* to = e->getToNode();
488 if (to->isTLControlled()) {
489 tlsLookup[e] = to->getControllingTLS();
490 }
491 }
492
493 std::vector<NBNode*> toRemove;
494 for (const auto& i : myNodes) {
495 NBNode* const current = i.second;
496 bool remove = false;
497 // check for completely empty nodes and check for nodes which are only geometry nodes and ask the node whether to join
498 if (current->getEdges().empty() || (removeGeometryNodes && mySplit.count(current) == 0 && current->checkIsRemovable())) {
499 remove = true;
500 // check whether any of the edges must be kept
501 for (NBEdge* const it_edge : current->getEdges()) {
502 if (edges2keep.find(it_edge->getID()) != edges2keep.end()) {
503 remove = false;
504 break;
505 }
506 }
507 }
508 // remove the node and join the geometries when wished
509 if (!remove) {
510 continue;
511 }
512 for (const std::pair<NBEdge*, NBEdge*>& j : current->getEdgesToJoin()) {
513 NBEdge* const begin = j.first;
514 NBEdge* const continuation = j.second;
515 begin->append(continuation);
516 continuation->getToNode()->replaceIncoming(continuation, begin, 0);
517 auto itTL = tlsLookup.find(continuation);
518 if (itTL != tlsLookup.end()) {
519 for (NBTrafficLightDefinition* tls : itTL->second) {
520 tls->replaceRemoved(continuation, -1, begin, -1, true);
521 }
522 tlsLookup[begin] = itTL->second;
523 }
524 sc.replaceEdge(continuation->getID(), { begin });
525 lc.replaceEdge(continuation->getID(), { begin });
526 ec.extract(dc, continuation, true);
527 }
528 toRemove.push_back(current);
529 }
530 // erase all
531 for (NBNode* n : toRemove) {
532 extract(n, true);
533 }
534 return (int)toRemove.size();
535}
536
537
538void
540 for (NodeCont::iterator i = myNodes.begin(); i != myNodes.end(); i++) {
541 (*i).second->avoidOverlap();
542 }
543}
544
545
546// ----------- (Helper) methods for joining nodes
547void
548NBNodeCont::generateNodeClusters(double maxDist, NodeClusters& into) const {
549 std::set<NBNode*> visited;
550 for (const auto& i : myNodes) {
551 if (visited.count(i.second) > 0) {
552 continue;
553 }
554 std::vector<NodeAndDist> toProc;
555 toProc.emplace_back(i.second, 0.);
556 NodeSet c;
557 while (!toProc.empty()) {
558 NBNode* const n = toProc.back().first;
559 const double dist = toProc.back().second;
560 toProc.pop_back();
561 if (visited.count(n) > 0) {
562 continue;
563 }
564 visited.insert(n);
565 bool pureRail = true;
566 bool railAndPeds = true;
567 for (NBEdge* e : n->getEdges()) {
568 if ((e->getPermissions() & ~(SVC_RAIL_CLASSES | SVC_PEDESTRIAN)) != 0) {
569 railAndPeds = false;
570 pureRail = false;
571 break;
572 }
573 if ((e->getPermissions() & ~(SVC_RAIL_CLASSES)) != 0) {
574 pureRail = false;
575 }
576 }
577 if (pureRail) {
578 // do not join pure rail nodes
579 continue;
580 }
581 c.insert(n);
582 for (NBEdge* e : n->getEdges()) {
583 NBNode* s = n->hasIncoming(e) ? e->getFromNode() : e->getToNode();
584 const double length = e->getLoadedLength();
585#ifdef DEBUG_JOINJUNCTIONS
586 if (DEBUGCOND(s)) {
587 std::cout << "generateNodeClusters: consider s=" << s->getID()
588 << " clusterNode=" << n->getID() << " edge=" << e->getID() << " dist=" << dist << " length=" << length << " with cluster " << joinNamedToString(c, ' ') << "\n";
589 }
590#endif
591 if (railAndPeds && n->getType() != SumoXMLNodeType::RAIL_CROSSING) {
592 bool railAndPeds2 = true;
593 for (NBEdge* e2 : n->getEdges()) {
594 if ((e2->getPermissions() & ~(SVC_RAIL_CLASSES | SVC_PEDESTRIAN)) != 0) {
595 railAndPeds2 = false;
596 break;
597 }
598 }
599 if (railAndPeds2 && s->getType() != SumoXMLNodeType::RAIL_CROSSING) {
600 // do not join rail/ped nodes unless at a rail crossing
601 // (neither nodes nor the traffic lights)
602 continue;
603 }
604 }
605 const bool bothCrossing = n->getType() == SumoXMLNodeType::RAIL_CROSSING && s->getType() == SumoXMLNodeType::RAIL_CROSSING;
606 const bool joinPedCrossings = bothCrossing && e->getPermissions() == SVC_PEDESTRIAN;
607 if ( // never join pedestrian stuff (unless at a rail crossing
608 !joinPedCrossings && (
609 e->getPermissions() == SVC_PEDESTRIAN
610 // only join edges for regular passenger traffic or edges that are extremely short
611 || (length > 3 * POSITION_EPS
612 && (e->getPermissions() & (SVC_PASSENGER | SVC_TRAM)) == 0
614#ifdef DEBUG_JOINJUNCTIONS
615 if (DEBUGCOND(s)) {
616 std::cout << " ignored s=" << s->getID() << " pedestrian edge=" << e->getID() << " cd=" << n->getPosition().distanceTo2D(s->getPosition()) << "\n";
617 }
618#endif
619 continue;
620 }
621 // never join rail_crossings with other node types unless the crossing is only for tram
624 const SVCPermissions railNoTram = (SVC_RAIL_CLASSES & ~SVC_TRAM);
625 bool foundRail = false;
626 NBNode* crossingNode = n->getType() == SumoXMLNodeType::RAIL_CROSSING ? n : s;
627 for (NBEdge* e2 : crossingNode->getIncomingEdges()) {
628 if ((e2->getPermissions() & railNoTram) != 0) {
629 foundRail = true;
630 break;
631 }
632 }
633 if (foundRail) {
634 continue;
635 }
636 }
637 // never join rail_crossings via a rail edge
638 if (bothCrossing && (e->getPermissions() & ~SVC_RAIL_CLASSES) == 0) {
639 continue;
640 }
641 if (visited.find(s) != visited.end()) {
642 continue;
643 }
644 if (length + dist < maxDist) {
645 // don't add long "boring" appendages but always join the whole rail crossing or tls
646 const bool trueGeomLike = s->geometryLike();
647 if (trueGeomLike || geometryLikeForClass(s, SVC_VULNERABLE | SVC_DELIVERY)) {
648 const bool hasTLS = n->isTrafficLight() || s->isTrafficLight();
649 const double fullLength = e->getGeometry().length2D();
650 const double length2 = bothCrossing || hasTLS || trueGeomLike ? length : fullLength;
651 toProc.emplace_back(s, dist + length2);
652 } else {
653 toProc.emplace_back(s, 0.);
654 }
655 }
656 }
657 }
658 if (c.size() < 2) {
659 continue;
660 }
661#ifdef DEBUG_JOINJUNCTIONS
662 std::cout << " DEBUG: consider cluster " << joinNamedToString(c, ' ') << "\n";
663#endif
664 into.push_back(c);
665 }
666}
667
668
669bool
671 EdgeVector allowedIn;
672 EdgeVector allowedOut;
673 for (NBEdge* e : n->getIncomingEdges()) {
674 if ((e->getPermissions() & ~ignored) != 0) {
675 allowedIn.push_back(e);
676 }
677 }
678 for (NBEdge* e : n->getOutgoingEdges()) {
679 if ((e->getPermissions() & ~ignored) != 0) {
680 allowedOut.push_back(e);
681 }
682 }
683 if (allowedIn.size() > 0 && allowedOut.size() > 0) {
684 //std::cout << n->getID() << " geometryLikeForClass=" << n->geometryLike(allowedIn, allowedOut) << " in=" << toString(allowedIn) << " out=" << toString(allowedOut) << "\n";
685 return n->geometryLike(allowedIn, allowedOut);
686 }
687 return true;
688}
689
690
691void
692NBNodeCont::addJoinExclusion(const std::vector<std::string>& ids) {
693 for (const std::string& nodeID : ids) {
694 // error handling has to take place here since joinExclusions could be
695 // loaded from multiple files / command line
696 if (myJoined.count(nodeID) > 0) {
697 WRITE_WARNINGF(TL("Ignoring join exclusion for junction '%' since it already occurred in a list of nodes to be joined."), nodeID);
698 } else {
699 myJoinExclusions.insert(nodeID);
700 }
701 }
702}
703
704
705std::string
706NBNodeCont::createClusterId(const std::set<std::string>& cluster, const std::string& prefix) {
707 int maxIds = OptionsCont::getOptions().getInt("max-join-ids");
708 if (maxIds <= 0) {
709 maxIds = (int)cluster.size();
710 }
711 if ((int)cluster.size() > maxIds) {
712 auto clusterIt = cluster.begin();
713 std::string result = prefix + *clusterIt;
714 for (int i = 1; i < maxIds; i++) {
715 ++clusterIt;
716 result += "_" + *clusterIt;
717 }
718 return result + "_#" + toString((int)cluster.size() - maxIds) + "more";
719 }
720 return prefix + joinToString(cluster, "_");
721}
722
723
724void
725NBNodeCont::addCluster2Join(const std::set<std::string>& cluster, NBNode* node) {
726 // error handling has to take place here since joins could be loaded from multiple files
727 std::set<std::string> validCluster;
728 for (std::string nodeID : cluster) {
729 if (myJoinExclusions.count(nodeID) > 0) {
730 WRITE_WARNINGF(TL("Ignoring join-cluster because junction '%' was already excluded from joining."), nodeID);
731 return;
732 } else if (myJoined.count(nodeID) > 0) {
733 WRITE_WARNINGF(TL("Ignoring join-cluster because junction '%' already occurred in another join-cluster."), nodeID);
734 return;
735 } else {
736 if (retrieve(nodeID) != nullptr) {
737 validCluster.insert(nodeID);
738 } else {
739 WRITE_ERRORF(TL("Unknown junction '%' in join-cluster."), nodeID);
740 }
741 }
742 }
743 if (validCluster.size() > 1) {
744 myJoined.insert(validCluster.begin(), validCluster.end());
745 myClusters2Join.push_back(std::make_pair(validCluster, node));
746 } else {
747 WRITE_WARNINGF(TL("Ignoring join-cluster '%' because it has size '%'."), node->getID(), validCluster.size());
748 }
749}
750
751
752int
754 int numJoined = 0;
755 for (auto& item : myClusters2Join) {
756 // verify loaded cluster
757 NodeSet cluster;
758 for (std::string nodeID : item.first) {
759 NBNode* node = retrieve(nodeID);
760 if (node == nullptr) {
761 WRITE_ERRORF(TL("unknown junction '%' while joining."), nodeID);
762 } else {
763 cluster.insert(node);
764 }
765 }
766 if (cluster.size() > 1) {
767 joinNodeCluster(cluster, dc, ec, tlc, item.second);
768 numJoined++;
769 myJoinExclusions.insert(item.second->getID());
770 }
771 }
772 myClusters2Join.clear(); // make save for recompute
773 return numJoined;
774}
775
776
777int
779#ifdef DEBUG_JOINJUNCTIONS
780 std::cout << "joinJunctions...\n";
781#endif
782 NodeClusters cands;
783 NodeClusters clusters;
784 std::map<const NBNode*, std::vector<NBNode*> > ptStopEnds;
785 // check for stop edges within the cluster
786 for (const auto& stopIt : sc.getStops()) {
787 NBEdge* edge = ec.retrieve(stopIt.second->getEdgeId());
788 if (edge != nullptr) {
789 ptStopEnds[edge->getFromNode()].push_back(edge->getToNode());
790 }
791 }
792 generateNodeClusters(maxDist, cands);
793 for (NodeSet& cluster : cands) {
794#ifdef DEBUG_JOINJUNCTIONS
795 gDebugFlag1 = false;
796 for (NBNode* n : cluster) {
797 if (DEBUGCOND(n)) {
798 gDebugFlag1 = true;
799 }
800 }
801#endif
802 // remove join exclusions
803 for (NodeSet::iterator j = cluster.begin(); j != cluster.end();) {
804 NodeSet::iterator check = j;
805 ++j;
806 if (myJoinExclusions.count((*check)->getID()) > 0) {
807 cluster.erase(check);
808 }
809 }
810 std::string origCluster = joinNamedToString(cluster, ',');
811 // remove nodes that can be eliminated by geometry.remove
812 pruneClusterFringe(cluster, maxDist);
813 if (cluster.size() < 2) {
814 continue;
815 }
816 // remove nodes that are part of a bypass lane (typically for turning right without waiting at a traffic light)
817 pruneSlipLaneNodes(cluster, maxDist);
818 if (cluster.size() < 2) {
819 WRITE_WARNINGF(TL("Not joining junctions % (%)."), origCluster, "slip lane");
820 continue;
821 }
822 origCluster = joinNamedToString(cluster, ',');
823 NBNode* tryRemove = nullptr;
824 std::string reason;
825 std::string origReason;
826 // pruneLongEdges might remove too much, so we check first to have a fallback with the circles
827 bool feasible = feasibleCluster(cluster, ptStopEnds, maxDist, origReason, tryRemove);
828 if (feasible && ((int)cluster.size() - pruneLongEdges(cluster, maxDist, true) < 2)) {
829 origReason = "long edge";
830 feasible = false;
831 }
832 if (!feasible) {
833#ifdef DEBUG_JOINJUNCTIONS
834 if (gDebugFlag1) {
835 std::cout << " try to reduce to 4-circle nodes=" << joinNamedToString(cluster, ',') << "\n";
836 }
837#endif
838 if (reduceToCircle(cluster, 4, cluster, maxDist)) {
839 feasible = feasibleCluster(cluster, ptStopEnds, maxDist, reason, tryRemove);
840 if (feasible) {
841 WRITE_WARNINGF(TL("Reducing junction cluster % (%)."), origCluster, origReason);
842 }
843 }
844 }
845 if (!feasible) {
846#ifdef DEBUG_JOINJUNCTIONS
847 if (gDebugFlag1) {
848 std::cout << " try to reduce to 2-circle nodes=" << joinNamedToString(cluster, ',') << "\n";
849 }
850#endif
851 if (reduceToCircle(cluster, 2, cluster, maxDist)) {
852 feasible = feasibleCluster(cluster, ptStopEnds, maxDist, reason, tryRemove);
853 if (feasible) {
854 WRITE_WARNINGF(TL("Reducing junction cluster % (%)."), origCluster, origReason);
855 }
856 }
857 }
858 while (!feasible && tryRemove != nullptr) {
859 cluster.erase(tryRemove);
860 pruneClusterFringe(cluster, maxDist);
861 tryRemove = nullptr;
862 feasible = feasibleCluster(cluster, ptStopEnds, maxDist, reason, tryRemove);
863 if (feasible) {
864 WRITE_WARNINGF(TL("Reducing junction cluster % (%)."), origCluster, origReason);
865 }
866 }
867 if (cluster.size() < 2) {
868 WRITE_WARNINGF(TL("Not joining junctions % (%)."), origCluster, "after reduction");
869 continue;
870 }
871 // avoid removal of long edges (must have been added via an alternative path).
872 const int numPruned = pruneLongEdges(cluster, maxDist);
873 if (cluster.size() < 2) {
874 WRITE_WARNINGF(TL("Not joining junctions % (%)."), origCluster, "long edge");
875 continue;
876 }
877 // after pruning long edges we have to recheck
878 if (numPruned > 0) {
879 pruneClusterFringe(cluster, maxDist);
880 if (cluster.size() < 2) {
881 WRITE_WARNINGF(TL("Not joining junctions % (%)."), origCluster, "long edge");
882 continue;
883 }
884 pruneSlipLaneNodes(cluster, maxDist);
885 if (cluster.size() < 2) {
886 WRITE_WARNINGF(TL("Not joining junctions % (%)."), origCluster, "slip lane");
887 continue;
888 }
889 }
890 feasible = feasibleCluster(cluster, ptStopEnds, maxDist, origReason, tryRemove);
891 if (!feasible) {
892 WRITE_WARNINGF(TL("Not joining junctions % (%)."), origCluster, origReason);
893 continue;
894 }
895 // compute all connected components of this cluster
896 // (may be more than 1 if intermediate nodes were removed)
897 NodeClusters components;
898 for (NBNode* current : cluster) {
899 // merge all connected components into newComp
900 NodeSet newComp;
901 //std::cout << "checking connectivity for " << current->getID() << "\n";
902 newComp.insert(current);
903 for (NodeClusters::iterator it_comp = components.begin(); it_comp != components.end();) {
904 NodeClusters::iterator check = it_comp;
905 //std::cout << " connected with " << toString(*check) << "?\n";
906 bool connected = false;
907 for (NBNode* k : *check) {
908 if (current->getConnectionTo(k) != nullptr || k->getConnectionTo(current) != nullptr) {
909 //std::cout << "joining with connected component " << toString(*check) << "\n";
910 newComp.insert((*check).begin(), (*check).end());
911 it_comp = components.erase(check);
912 connected = true;
913 break;
914 }
915 }
916 if (!connected) {
917 it_comp++;
918 }
919 }
920 //std::cout << "adding new component " << toString(newComp) << "\n";
921 components.push_back(newComp);
922 }
923 for (NodeClusters::iterator it_comp = components.begin(); it_comp != components.end(); ++it_comp) {
924 if ((*it_comp).size() > 1) {
925 //std::cout << "adding cluster " << toString(*it_comp) << "\n";
926 clusters.push_back(*it_comp);
927 }
928 }
929#ifdef DEBUG_JOINJUNCTIONS
930 gDebugFlag1 = false;
931#endif
932 }
933 joinNodeClusters(clusters, dc, ec, tlc);
934 return (int)clusters.size();
935}
936
937
938int
940#ifdef DEBUG_JOINJUNCTIONS
941 std::cout << "joinSameJunctions...\n";
942#endif
943 std::map<std::string, NodeSet> positions;
944 for (auto& item : myNodes) {
945 Position pos = item.second->getPosition();
946 std::string rounded = (OutputDevice::realString(pos.x(), gPrecision)
948 + "_" + OutputDevice::realString(pos.z(), gPrecision));
949 positions[rounded].insert(item.second);
950 }
951 NodeClusters clusters;
952 for (auto& item : positions) {
953 if (item.second.size() > 1) {
954 for (NBNode* n : item.second) {
955 if (myJoinExclusions.count(n->getID()) > 0) {
956 item.second.erase(n);
957 }
958 }
959 if (item.second.size() > 1) {
960 clusters.push_back(item.second);
961 }
962 }
963 }
964 joinNodeClusters(clusters, dc, ec, tlc, true);
965 return (int)clusters.size();
966}
967
968void
969NBNodeCont::pruneClusterFringe(NodeSet& cluster, double maxDist, bool remove2TLS) const {
970#ifdef DEBUG_JOINJUNCTIONS
971 if (gDebugFlag1) {
972 std::cout << "pruning cluster=" << joinNamedToString(cluster, ' ') << "\n";
973 }
974#endif
975 // iteratively remove the fringe
976 NodeSet geometryLikeTLS;
977 bool pruneFringe = true;
978 bool pruneNoisyFringe = false;
979 // collect nodes that shall be joined due to distance but are not connected
980 // to the cluster for passenger traffic
981 while (pruneFringe) {
982 pruneFringe = false;
983 for (NodeSet::iterator j = cluster.begin(); j != cluster.end();) {
984 NodeSet::iterator check = j;
985 NBNode* n = *check;
986 ++j;
987
988 // compute clusterDist for node (length of shortest edge which connects this node to the cluster)
989 double clusterDist = std::numeric_limits<double>::max();
990 bool touchingCluster = false;
991 for (EdgeVector::const_iterator it_edge = n->getOutgoingEdges().begin(); it_edge != n->getOutgoingEdges().end(); ++it_edge) {
992 NBNode* neighbor = (*it_edge)->getToNode();
993 if (cluster.count(neighbor) != 0) {
994 clusterDist = MIN2(clusterDist, (*it_edge)->getLoadedLength());
995 touchingCluster |= n->getPosition().distanceTo2D(neighbor->getPosition()) <= SUMO_const_laneWidth;
996 }
997 }
998 for (EdgeVector::const_iterator it_edge = n->getIncomingEdges().begin(); it_edge != n->getIncomingEdges().end(); ++it_edge) {
999 NBNode* neighbor = (*it_edge)->getFromNode();
1000 if (cluster.count(neighbor) != 0) {
1001 clusterDist = MIN2(clusterDist, (*it_edge)->getLoadedLength());
1002 touchingCluster |= n->getPosition().distanceTo2D(neighbor->getPosition()) <= SUMO_const_laneWidth;
1003 }
1004 }
1005 // remove geometry-like nodes at fringe of the cluster
1006 // (they have 1 neighbor in the cluster and at most 1 neighbor outside the cluster)
1007 std::set<NBNode*> outsideNeighbors;
1008 std::set<NBNode*> clusterNeighbors;
1009 const double pedestrianFringeThreshold = 0.3;
1010 for (NBEdge* e : n->getEdges()) {
1011 NBNode* neighbor = e->getFromNode() == n ? e->getToNode() : e->getFromNode();
1012 if (cluster.count(neighbor) == 0) {
1013 if ((e->getPermissions() & SVC_PASSENGER) != 0
1014 || isRailway(e->getPermissions()) // join railway crossings
1015 || (clusterDist <= pedestrianFringeThreshold
1016 && (!pruneNoisyFringe
1017 || isForVulnerableModes(e->getPermissions())
1018 // permit joining small opposite merges
1019 || getDiameter(cluster) < maxDist
1020 || cluster.size() == 2))
1021 || touchingCluster) {
1022 outsideNeighbors.insert(neighbor);
1023 }
1024 } else {
1025 clusterNeighbors.insert(neighbor);
1026 }
1027 }
1028#ifdef DEBUG_JOINJUNCTIONS
1029 if (gDebugFlag1) std::cout << " check n=" << n->getID()
1030 << " clusterDist=" << clusterDist
1031 << " cd<th=" << (clusterDist <= pedestrianFringeThreshold)
1032 << " touching=" << touchingCluster
1033 << " out=" << joinNamedToString(outsideNeighbors, ',')
1034 << " in=" << joinNamedToString(clusterNeighbors, ',')
1035 << " dia=" << getDiameter(cluster)
1036 << "\n";
1037#endif
1038 if (clusterNeighbors.size() == 0
1039 || (outsideNeighbors.size() <= 1
1040 && clusterNeighbors.size() == 1
1041 && !(n->isTLControlled() /*|| n->hadSignal()*/))) {
1042 cluster.erase(check);
1043 pruneFringe = true; // other nodes could belong to the fringe now
1044#ifdef DEBUG_JOINJUNCTIONS
1045 if (gDebugFlag1) {
1046 std::cout << " pruned n=" << n->getID() << "\n";
1047 }
1048#endif
1049 } else if (outsideNeighbors.size() <= 1 && clusterNeighbors.size() == 1) {
1050 geometryLikeTLS.insert(n);
1051 }
1052 }
1053 if (!pruneFringe && !pruneNoisyFringe) {
1054 // run once more and prune more things (with a look at cluster size)
1055 pruneFringe = true;
1056 pruneNoisyFringe = true;
1057
1058 }
1059 }
1060 if (remove2TLS && geometryLikeTLS.size() == cluster.size()) {
1061 cluster.clear();
1062 }
1063}
1064
1065double
1067 double result = 0;
1068 for (const NBNode* n1 : cluster) {
1069 for (const NBNode* n2 : cluster) {
1070 result = MAX2(result, n1->getPosition().distanceTo2D(n2->getPosition()));
1071 }
1072 }
1073 return result;
1074}
1075
1076int
1077NBNodeCont::pruneLongEdges(NodeSet& cluster, double maxDist, const bool dryRun) {
1078 std::set<NBNode*> toRemove;
1079 int maxPassengerLanes = 0;
1080 for (NBNode* n : cluster) {
1081 for (NBEdge* edge : n->getEdges()) {
1082 maxPassengerLanes = MAX2(maxPassengerLanes, edge->getNumLanesThatAllow(SVC_PASSENGER));
1083 }
1084 }
1085 for (NBNode* n : cluster) {
1086 for (NBEdge* edge : n->getOutgoingEdges()) {
1087 // we must track the edge length across geometry like nodes
1088 // Also, intersections that are geometry-like
1089 // from the perspective of passenger traffic should be tracked across
1090 std::vector<NBNode*> passed;
1091 double length = 0;
1092 NBEdge* cur = edge;
1093 NBNode* to = edge->getToNode();
1094 while (cluster.count(to) != 0) {
1095 length += cur->getLoadedLength();
1096 bool goStraight = (std::find(passed.begin(), passed.end(), to) == passed.end()
1097 && (edge->getPermissions() & SVC_PASSENGER) != 0
1098 && to->geometryLike(
1101 passed.push_back(to);
1102 if (goStraight) {
1104 if (cur != nullptr) {
1105 to = cur->getToNode();
1106 } else {
1107 break;
1108 }
1109 } else {
1110 break;
1111 }
1112 }
1113 // allow higher threshold at larger junctions
1114 double longThreshold = maxDist + SUMO_const_laneWidth * MAX2(0, maxPassengerLanes - 1);
1115#ifdef DEBUG_JOINJUNCTIONS
1116 if (gDebugFlag1) {
1117 std::cout << "check edge length " << edge->getID() << " (" << length << ", passed=" << passed.size() << ", max=" << longThreshold << ")\n";
1118 }
1119#endif
1120 if (length > longThreshold) {
1121 // we found an edge that should not be removed. Maybe we can
1122 // still keep the start or end in the cluster
1123 // (keep the start if the end can be removed and vice versa)
1124 const bool keepStart = getClusterNeighbors(passed.back(), longThreshold, cluster).size() == 1;
1125 const bool keepEnd = !keepStart && getClusterNeighbors(n, longThreshold, cluster).size() == 1;
1126#ifdef DEBUG_JOINJUNCTIONS
1127 if (gDebugFlag1) {
1128 std::cout << "node=" << n->getID() << " long edge " << edge->getID() << " (" << length << ", passed=" << toString(passed) << ", max=" << longThreshold << ") keepStart=" << keepStart << " keepEnd=" << keepEnd << "\n";
1129 }
1130#endif
1131 if (!keepStart) {
1132 toRemove.insert(n);
1133 }
1134 toRemove.insert(passed.begin(), passed.end() - 1);
1135 if (!keepEnd) {
1136 toRemove.insert(passed.back());
1137 }
1138
1139 }
1140 }
1141 }
1142 if (!dryRun) {
1143 for (std::set<NBNode*>::iterator j = toRemove.begin(); j != toRemove.end(); ++j) {
1144 cluster.erase(*j);
1145 }
1146 }
1147 return (int)toRemove.size();
1148}
1149
1150
1151NodeSet
1152NBNodeCont::getClusterNeighbors(const NBNode* n, double longThreshold, NodeSet& cluster) {
1153 NodeSet result;
1154 for (NBEdge* e : n->getEdges()) {
1155 if (e->getLength() > longThreshold) {
1156 continue;
1157 }
1158 NBNode* neighbor = e->getFromNode() == n ? e->getToNode() : e->getFromNode();
1159 if (cluster.count(neighbor) != 0) {
1160 result.insert(neighbor);
1161 }
1162 }
1163 return result;
1164}
1165
1166
1167void
1168NBNodeCont::pruneSlipLaneNodes(NodeSet& cluster, double maxDist) const {
1169#ifdef DEBUG_JOINJUNCTIONS
1170 if (gDebugFlag1) {
1171 std::cout << "pruning slip-lanes at cluster=" << joinNamedToString(cluster, ' ') << "\n";
1172 }
1173#endif
1174 // fringe has already been removed
1175 if (cluster.size() <= 2) {
1176 return;
1177 }
1178 NodeSet toRemove;
1179 for (NBNode* n : cluster) {
1180 EdgeVector outgoing;
1181 double inAngle;
1182 // find slip lanes where the start is part of the cluster
1183 if (maybeSlipLaneStart(n, outgoing, inAngle)) {
1184 // potential slip lane start but we don't know which of the outgoing edges it is
1185#ifdef DEBUG_JOINJUNCTIONS
1186 if (gDebugFlag1) {
1187 std::cout << " candidate slip-lane start=" << n->getID() << " outgoing=" << toString(outgoing) << "\n";
1188 }
1189#endif
1190 for (NBEdge* contEdge : outgoing) {
1191 if ((contEdge->getPermissions() & SVC_PASSENGER) == 0) {
1192 continue;
1193 }
1194 double slipLength = contEdge->getLength();
1195 NBNode* cont = contEdge->getToNode();
1196 NodeSet cands;
1197 cands.insert(n);
1198 while (isSlipLaneContinuation(cont) && slipLength < MAX_SLIPLANE_LENGTH) {
1199 if (cands.count(cont) != 0) {
1200 break; // circle, should not happen
1201 }
1202 cands.insert(cont);
1203#ifdef DEBUG_JOINJUNCTIONS
1204 if (gDebugFlag1) {
1205 std::cout << " candidate slip-lane cont=" << cont->getID() << "\n";
1206 }
1207#endif
1208 NBEdge* next = cont->getOutgoingEdges().front();
1209 slipLength += next->getLength();
1210 cont = next->getToNode();
1211 }
1212#ifdef DEBUG_JOINJUNCTIONS
1213 if (gDebugFlag1) {
1214 std::cout << " candidate slip-lane end=" << cont->getID() << " slipLength=" << slipLength << "\n";
1215 }
1216#endif
1217 if (cont->getIncomingEdges().size() >= 2 && cont->getOutgoingEdges().size() == 1 &&
1218 // slip lanes are for turning so there needs to be a sufficient angle
1219 abs(NBHelpers::relAngle(inAngle, cont->getOutgoingEdges().front()->getAngleAtNode(cont))) > 45) {
1220 // check whether the other continuation at n is also connected to the sliplane end
1221 const NBEdge* const otherEdge = (contEdge == outgoing.front() ? outgoing.back() : outgoing.front());
1222 NodeSet visited;
1223 visited.insert(n);
1224 std::vector<NodeAndDist> toProc;
1225 toProc.push_back(std::make_pair(otherEdge->getToNode(), otherEdge->getLength()));
1226 bool found = false;
1227 while (!toProc.empty()) {
1228 NodeAndDist nodeAndDist = toProc.back();
1229 NBNode* cont2 = nodeAndDist.first;
1230 double dist = nodeAndDist.second;
1231#ifdef DEBUG_JOINJUNCTIONS
1232 if (gDebugFlag1) {
1233 std::cout << " search alternative cont2=" << cont2->getID() << " dist=" << dist << "\n";
1234 }
1235#endif
1236 toProc.pop_back();
1237 if (visited.find(cont2) != visited.end()) {
1238 continue;
1239 }
1240 visited.insert(cont2);
1241 if (cont2 == cont) {
1242 found = true;
1243 break;
1244 }
1245 for (NBEdge* e : cont2->getOutgoingEdges()) {
1246 const double dist2 = dist + e->getLength();
1247 if (dist2 < slipLength * 2 && (e->getPermissions() & SVC_PASSENGER) != 0) {
1248 toProc.push_back(std::make_pair(e->getToNode(), dist2));
1249 }
1250 }
1251 }
1252 if (found) {
1253 // found slip lane
1254 cands.insert(cont);
1255 toRemove.insert(cands.begin(), cands.end());
1256#ifdef DEBUG_JOINJUNCTIONS
1257 if (gDebugFlag1) {
1258 std::cout << " found slip-lane with nodes=" << joinNamedToString(cands, ' ') << "\n";
1259 }
1260#endif
1261 }
1262 }
1263 }
1264 }
1265
1266 EdgeVector incoming;
1267 double outAngle;
1268 // find slip lanes where the end is part of the cluster
1269 if (maybeSlipLaneEnd(n, incoming, outAngle)) {
1270 // potential slip lane end but we don't know which of the incoming edges it is
1271#ifdef DEBUG_JOINJUNCTIONS
1272 if (gDebugFlag1) {
1273 std::cout << " candidate slip-lane end=" << n->getID() << " incoming=" << toString(incoming) << "\n";
1274 }
1275#endif
1276 for (NBEdge* contEdge : incoming) {
1277 if ((contEdge->getPermissions() & SVC_PASSENGER) == 0) {
1278 continue;
1279 }
1280 double slipLength = contEdge->getLength();
1281 NBNode* cont = contEdge->getFromNode();
1282 NodeSet cands;
1283 cands.insert(n);
1284 while (isSlipLaneContinuation(cont) && slipLength < MAX_SLIPLANE_LENGTH) {
1285 if (cands.count(cont) != 0) {
1286 break; // circle, should not happen
1287 }
1288 cands.insert(cont);
1289#ifdef DEBUG_JOINJUNCTIONS
1290 if (gDebugFlag1) {
1291 std::cout << " candidate slip-lane cont=" << cont->getID() << "\n";
1292 }
1293#endif
1294 NBEdge* next = cont->getIncomingEdges().front();
1295 slipLength += next->getLength();
1296 cont = next->getFromNode();
1297 }
1298#ifdef DEBUG_JOINJUNCTIONS
1299 if (gDebugFlag1) {
1300 std::cout << " candidate slip-lane start=" << cont->getID() << " slipLength=" << slipLength << "\n";
1301 }
1302#endif
1303 if (cont->getOutgoingEdges().size() >= 2 && cont->getIncomingEdges().size() == 1 &&
1304 // slip lanes are for turning so there needs to be a sufficient angle
1305 abs(NBHelpers::relAngle(outAngle, cont->getIncomingEdges().front()->getAngleAtNode(cont))) > 45) {
1306 // check whether the other continuation at n is also connected to the sliplane end
1307 const NBEdge* const otherEdge = (contEdge == incoming.front() ? incoming.back() : incoming.front());
1308 NodeSet visited;
1309 visited.insert(n);
1310 std::vector<NodeAndDist> toProc;
1311 toProc.push_back(std::make_pair(otherEdge->getFromNode(), otherEdge->getLength()));
1312 bool found = false;
1313 while (!toProc.empty()) {
1314 NodeAndDist nodeAndDist = toProc.back();
1315 NBNode* cont2 = nodeAndDist.first;
1316 double dist = nodeAndDist.second;
1317#ifdef DEBUG_JOINJUNCTIONS
1318 if (gDebugFlag1) {
1319 std::cout << " search alternative cont2=" << cont2->getID() << " dist=" << dist << "\n";
1320 }
1321#endif
1322 toProc.pop_back();
1323 if (visited.find(cont2) != visited.end()) {
1324 continue;
1325 }
1326 visited.insert(cont2);
1327 if (cont2 == cont) {
1328 found = true;
1329 break;
1330 }
1331 for (NBEdge* e : cont2->getIncomingEdges()) {
1332 const double dist2 = dist + e->getLength();
1333 if (dist2 < slipLength * 2 && (e->getPermissions() & SVC_PASSENGER) != 0) {
1334 toProc.push_back(std::make_pair(e->getFromNode(), dist2));
1335 }
1336 }
1337 }
1338 if (found) {
1339 // found slip lane
1340 cands.insert(cont);
1341 toRemove.insert(cands.begin(), cands.end());
1342#ifdef DEBUG_JOINJUNCTIONS
1343 if (gDebugFlag1) {
1344 std::cout << " found slip-lane start with nodes=" << joinNamedToString(cands, ' ') << "\n";
1345 }
1346#endif
1347 }
1348 }
1349 }
1350 }
1351
1352
1353
1354 }
1355 int numRemoved = 0;
1356 for (NBNode* n : toRemove) {
1357 numRemoved += (int)cluster.erase(n);
1358 }
1359 if (numRemoved > 0) {
1360#ifdef DEBUG_JOINJUNCTIONS
1361 if (gDebugFlag1) {
1362 std::cout << " removed " << numRemoved << " nodes from cluster: " << joinNamedToString(toRemove, ' ') << "\n";
1363 }
1364#endif
1365 pruneClusterFringe(cluster, maxDist);
1366 }
1367}
1368
1369
1370bool
1372 return cont->getPassengerEdges(true).size() == 1 && cont->getPassengerEdges(false).size() == 1;
1373}
1374
1375
1376bool
1377NBNodeCont::maybeSlipLaneStart(const NBNode* n, EdgeVector& outgoing, double& inAngle) const {
1378 EdgeVector inPE = n->getPassengerEdges(true);
1379 EdgeVector outPE = n->getPassengerEdges(false);
1380 if (inPE.size() == 1 && outPE.size() == 2) {
1381 outgoing.insert(outgoing.begin(), outPE.begin(), outPE.end());
1382 inAngle = inPE.front()->getAngleAtNode(n);
1383 return true;
1384 } else if (inPE.size() >= 2 && outPE.size() == 3) {
1385 // check if the incoming edges are going in opposite directions and then
1386 // use the incoming edge that has 2 almost-straight outgoing edges
1387 const double inRelAngle = fabs(NBHelpers::relAngle(inPE.front()->getAngleAtNode(n), inPE.back()->getAngleAtNode(n)));
1388 //std::cout << "n=" << n->getID() << " inRelAngle=" << inRelAngle << "\n";
1389 if (inRelAngle < 135) {
1390 return false; // not opposite incoming
1391 }
1392 for (NBEdge* in : inPE) {
1393 EdgeVector straight;
1394 int numReverse = 0;
1395 for (NBEdge* out : outPE) {
1396 const double outRelAngle = fabs(NBHelpers::relAngle(in->getAngleAtNode(n), out->getAngleAtNode(n)));
1397 if (outRelAngle <= 45) {
1398 straight.push_back(out);
1399 } else if (outRelAngle >= 135) {
1400 numReverse++;
1401 }
1402 }
1403 if (straight.size() == 2 && numReverse == 1) {
1404 outgoing.insert(outgoing.begin(), straight.begin(), straight.end());
1405 inAngle = in->getAngleAtNode(n);
1406 return true;
1407 }
1408 }
1409 }
1410 return false;
1411}
1412
1413
1414bool
1415NBNodeCont::maybeSlipLaneEnd(const NBNode* n, EdgeVector& incoming, double& outAngle) const {
1416 EdgeVector inPE = n->getPassengerEdges(true);
1417 EdgeVector outPE = n->getPassengerEdges(false);
1418 if (inPE.size() == 2 && outPE.size() == 1) {
1419 incoming.insert(incoming.begin(), inPE.begin(), inPE.end());
1420 outAngle = outPE.front()->getAngleAtNode(n);
1421 return true;
1422 } else if (inPE.size() == 3 && outPE.size() >= 2) {
1423 // check if the outgoing edges are going in opposite directions and then
1424 // use the outgoing edge that has 2 almost-straight incoming edges
1425 const double outRelAngle = fabs(NBHelpers::relAngle(outPE.front()->getAngleAtNode(n), outPE.back()->getAngleAtNode(n)));
1426 //std::cout << "n=" << n->getID() << " outRelAngle=" << outRelAngle << "\n";
1427 if (outRelAngle < 135) {
1428 return false; // not opposite outgoing
1429 }
1430 for (NBEdge* out : outPE) {
1431 EdgeVector straight;
1432 int numReverse = 0;
1433 for (NBEdge* in : inPE) {
1434 const double inRelAngle = fabs(NBHelpers::relAngle(in->getAngleAtNode(n), out->getAngleAtNode(n)));
1435 if (inRelAngle <= 45) {
1436 straight.push_back(in);
1437 } else if (inRelAngle >= 135) {
1438 numReverse++;
1439 }
1440 }
1441 if (straight.size() == 2 && numReverse == 1) {
1442 incoming.insert(incoming.begin(), straight.begin(), straight.end());
1443 outAngle = out->getAngleAtNode(n);
1444 return true;
1445 }
1446 }
1447 }
1448 return false;
1449}
1450
1451bool
1452NBNodeCont::feasibleCluster(const NodeSet& cluster, const std::map<const NBNode*, std::vector<NBNode*> >& ptStopEnds,
1453 double maxDist, std::string& reason, NBNode*& tryRemove) const {
1454 // check for clusters which are to complex and probably won't work very well
1455 // we count the incoming edges of the final junction
1456 std::map<NBEdge*, double, ComparatorIdLess> finalIncomingAngles;
1457 std::map<NBEdge*, double, ComparatorIdLess> finalOutgoingAngles;
1458 for (NBNode* n : cluster) {
1459 for (EdgeVector::const_iterator it_edge = n->getIncomingEdges().begin(); it_edge != n->getIncomingEdges().end(); ++it_edge) {
1460 NBEdge* edge = *it_edge;
1461 if (cluster.count(edge->getFromNode()) == 0 && (edge->getPermissions() & SVC_PASSENGER) != 0) {
1462 // incoming edge, does not originate in the cluster
1463 finalIncomingAngles[edge] = edge->getAngleAtNode(edge->getToNode());
1464 }
1465 }
1466 for (EdgeVector::const_iterator it_edge = n->getOutgoingEdges().begin(); it_edge != n->getOutgoingEdges().end(); ++it_edge) {
1467 NBEdge* edge = *it_edge;
1468 if (cluster.count(edge->getToNode()) == 0 && (edge->getPermissions() & SVC_PASSENGER) != 0) {
1469 // outgoing edge, does not end in the cluster
1470 finalOutgoingAngles[edge] = edge->getAngleAtNode(edge->getFromNode());
1471 }
1472 }
1473
1474 }
1475#ifdef DEBUG_JOINJUNCTIONS
1476 for (NBNode* n : cluster) {
1477 if (DEBUGCOND(n)) {
1478 std::cout << "feasibleCluster c=" << joinNamedToString(cluster, ',')
1479 << "\n inAngles=" << joinNamedToString(finalIncomingAngles, ' ', ':')
1480 << "\n outAngles=" << joinNamedToString(finalOutgoingAngles, ' ', ':')
1481 << "\n";
1482 }
1483 }
1484#endif
1485 if (finalIncomingAngles.size() > 5) {
1486 reason = toString(finalIncomingAngles.size()) + " incoming edges";
1487 return false;
1488 }
1489 // check for incoming parallel edges
1490 const double PARALLEL_THRESHOLD_DIFF_NODE = OptionsCont::getOptions().getFloat("junctions.join.parallel-threshold");
1491 const double PARALLEL_THRESHOLD_SAME_NODE = PARALLEL_THRESHOLD_DIFF_NODE / 3;
1492 bool foundParallel = false;
1493 for (auto j = finalIncomingAngles.begin(); j != finalIncomingAngles.end() && !foundParallel; ++j) {
1494 auto k = j;
1495 for (++k; k != finalIncomingAngles.end() && !foundParallel; ++k) {
1496 const double angleDiff = fabs(j->second - k->second);
1497 if (angleDiff < PARALLEL_THRESHOLD_DIFF_NODE) {
1498 NBEdge* e1 = j->first;
1499 NBEdge* e2 = k->first;
1500 // for edge targeting the same node, permit a narrower angle
1501 const double edgeDist = e1->getLaneShape(0).back().distanceTo2D(e2->getLaneShape(0).back());
1502#ifdef DEBUG_JOINJUNCTIONS
1503 if (DEBUGCOND(e1->getToNode())) {
1504 std::cout << " angleDiff=" << angleDiff << " shapeDist=" << edgeDist << "\n";
1505 }
1506#endif
1507 if (angleDiff >= PARALLEL_THRESHOLD_SAME_NODE && (
1508 (e1->getToNode() == e2->getToNode()
1509 || (edgeDist < maxDist)))) {
1510 continue;
1511 }
1512 reason = "parallel incoming " + e1->getID() + "," + e2->getID();
1513 if (e1->getToNode() != e2->getToNode() && (int)cluster.size() > 2) {
1514 // removing one of the nodes and try again
1515 if (e1->getPriority() > e2->getPriority()
1517 tryRemove = e2->getToNode();
1518 } else {
1519 tryRemove = e1->getToNode();
1520 }
1521 }
1522 return false;
1523 }
1524 }
1525 }
1526 // check for outgoing parallel edges
1527 for (auto j = finalOutgoingAngles.begin(); j != finalOutgoingAngles.end() && !foundParallel; ++j) {
1528 auto k = j;
1529 for (++k; k != finalOutgoingAngles.end() && !foundParallel; ++k) {
1530 const double angleDiff = fabs(j->second - k->second);
1531 if (angleDiff < PARALLEL_THRESHOLD_DIFF_NODE) {
1532 NBEdge* e1 = j->first;
1533 NBEdge* e2 = k->first;
1534 // for edge leaving the same node, permit a narrower angle
1535 const double edgeDist = e1->getLaneShape(0).front().distanceTo2D(e2->getLaneShape(0).front());
1536#ifdef DEBUG_JOINJUNCTIONS
1537 if (DEBUGCOND(e1->getFromNode())) {
1538 std::cout << " angleDiff=" << angleDiff << " shapeDist=" << edgeDist << "\n";
1539 }
1540#endif
1541 if (angleDiff >= PARALLEL_THRESHOLD_SAME_NODE && (
1542 (e1->getFromNode() == e2->getFromNode()
1543 || (edgeDist < maxDist)))) {
1544 continue;
1545 }
1546 reason = "parallel outgoing " + e1->getID() + "," + e2->getID();
1547 if (e1->getFromNode() != e2->getFromNode() && (int)cluster.size() > 2) {
1548 // removing one of the nodes and try again
1549 if (e1->getPriority() > e2->getPriority()
1551 tryRemove = e2->getFromNode();
1552 } else {
1553 tryRemove = e1->getFromNode();
1554 }
1555 }
1556 return false;
1557 }
1558 }
1559 }
1560 // check for stop edges and tls within the cluster
1561 bool hasTLS = false;
1562 for (NBNode* n : cluster) {
1563 if (n->isTLControlled() || n->hadSignal()) {
1564 hasTLS = true;
1565 }
1566 const auto& stopEnds = ptStopEnds.find(n);
1567 if (stopEnds != ptStopEnds.end()) {
1568 for (NBNode* const to : stopEnds->second) {
1569 if (cluster.count(to) != 0) {
1570 reason = "it contains a pt stop edge";
1571 return false;
1572 }
1573 }
1574 }
1575 }
1576 // prevent removal of long edges unless there is weak circle or a traffic light
1577 if (cluster.size() > 2) {
1578 // find the nodes with the biggests physical distance between them
1579 double maxLength = -1;
1580 NBEdge* maxEdge = nullptr;
1581 for (NBNode* n1 : cluster) {
1582 for (NBNode* n2 : cluster) {
1583 NBEdge* e1 = n1->getConnectionTo(n2);
1584 NBEdge* e2 = n2->getConnectionTo(n1);
1585 if (e1 != nullptr && e1->getLoadedLength() > maxLength) {
1586 maxLength = e1->getLoadedLength();
1587 maxEdge = e1;
1588 }
1589 if (e2 != nullptr && e2->getLoadedLength() > maxLength) {
1590 maxLength = e2->getLoadedLength();
1591 maxEdge = e2;
1592 }
1593 }
1594 }
1595#ifdef DEBUG_JOINJUNCTIONS
1596 for (NBNode* n : cluster) {
1597 if (DEBUGCOND(n)) {
1598 std::cout << "feasible hasTLS=" << hasTLS << " maxLength=" << maxLength << " maxEdge=" << maxEdge->getID() << "\n";
1599 }
1600 }
1601#endif
1602 if (!hasTLS && maxLength > 5) {
1603 // find a weak circle within cluster that does not use maxEdge
1604 std::vector<NBNode*> toCheck;
1605 std::set<NBNode*> visited;
1606 toCheck.push_back(maxEdge->getToNode());
1607 bool foundCircle = false;
1608 while (!toCheck.empty()) {
1609 NBNode* n = toCheck.back();
1610 if (n == maxEdge->getFromNode()) {
1611 foundCircle = true;
1612 break;
1613 }
1614 toCheck.pop_back();
1615 visited.insert(n);
1616 for (NBEdge* e : n->getEdges()) {
1617 if (e != maxEdge) {
1618 NBNode* cand = e->getFromNode() == n ? e->getToNode() : e->getFromNode();
1619 if (visited.count(cand) == 0 && cluster.count(cand) != 0) {
1620 toCheck.push_back(cand);
1621 }
1622 }
1623 }
1624 }
1625 if (!foundCircle) {
1626 reason = "not compact (maxEdge=" + maxEdge->getID() + " length=" + toString(maxLength) + ")";
1627 return false;
1628 }
1629 }
1630 }
1631 // prevent joining of simple merging/spreading structures
1632 if (cluster.size() >= 2) {
1633 int entryNodes = 0;
1634 int exitNodes = 0;
1635 EdgeVector outsideIncoming;
1636 EdgeVector outsideOutgoing;
1637 int edgesWithin = 0;
1638 for (NBNode* n : cluster) {
1639 bool foundOutsideIncoming = false;
1640 for (NBEdge* e : n->getIncomingEdges()) {
1641 if (cluster.count(e->getFromNode()) == 0) {
1642 // edge entering from outside the cluster
1643 outsideIncoming.push_back(e);
1644 foundOutsideIncoming = true;
1645 } else {
1646 edgesWithin++;
1647 }
1648 }
1649 if (foundOutsideIncoming) {
1650 entryNodes++;
1651 }
1652 bool foundOutsideOutgoing = false;
1653 for (NBEdge* e : n->getOutgoingEdges()) {
1654 if (cluster.count(e->getToNode()) == 0) {
1655 // edge leaving cluster
1656 outsideOutgoing.push_back(e);
1657 foundOutsideOutgoing = true;
1658 }
1659 }
1660 if (foundOutsideOutgoing) {
1661 exitNodes++;
1662 }
1663 }
1664 if (!hasTLS) {
1665 if (entryNodes < 2) {
1666 reason = "only 1 entry node";
1667 return false;
1668 }
1669 if (exitNodes < 2) {
1670 reason = "only 1 exit node";
1671 return false;
1672 }
1673 if (cluster.size() == 2) {
1674 if (edgesWithin == 1 && outsideIncoming.size() < 3 && outsideOutgoing.size() < 3) {
1675 reason = "only 1 edge within and no cross-traffic";
1676 return false;
1677 }
1678 }
1679 }
1680 /*
1681 if (NBNode::geometryLike(outsideIncoming, outsideOutgoing) && hasTLS && OptionsCont::getOptions().getBool("tls.discard-simple")) {
1682 reason = "geometry-like simple tls";
1683 return false;
1684 }
1685 */
1686 }
1687 return true;
1688}
1689
1690
1691bool
1692NBNodeCont::reduceToCircle(NodeSet& cluster, int circleSize, NodeSet startNodes, double maxDist, std::vector<NBNode*> cands) const {
1693#ifdef DEBUG_REDUCE
1694 std::cout << "reduceToCircle cs=" << circleSize << " cands=" << toString(cands, ',') << " startNodes=" << joinNamedToString(startNodes, ',') << "\n";
1695#endif
1696 assert(circleSize >= 2);
1697 if ((int)cands.size() == circleSize) {
1698 if (cands.back()->getConnectionTo(cands.front()) != nullptr) {
1699 // cluster found
1700 NodeSet candCluster;
1701 candCluster.insert(cands.begin(), cands.end());
1702 pruneClusterFringe(candCluster, maxDist, true);
1703 bool feasible = (int)candCluster.size() == circleSize;
1704 if (feasible) {
1705 cluster.clear();
1706 cluster.insert(cands.begin(), cands.end());
1707 }
1708 return feasible;
1709 } else {
1710 return false;
1711 }
1712 }
1713 if ((int)cluster.size() <= circleSize || startNodes.size() == 0) {
1714 // no reduction possible
1715#ifdef DEBUG_REDUCE
1716 std::cout << " abort\n";
1717#endif
1718 return false;
1719 }
1720 if (cands.size() == 0) {
1721 // try to find a circle starting from another start node
1722 NBEdge* e = shortestEdge(cluster, startNodes, cands);
1723 if (e != nullptr) {
1724 cands.push_back(e->getFromNode());
1725 startNodes.erase(e->getFromNode());
1726 if (reduceToCircle(cluster, circleSize, startNodes, maxDist, cands)) {
1727 return true;
1728 } else {
1729 // try another start node
1730 return reduceToCircle(cluster, circleSize, startNodes, maxDist);
1731 }
1732 }
1733 } else {
1734 NodeSet singleStart;
1735 singleStart.insert(cands.back());
1736 NBEdge* e = shortestEdge(cluster, singleStart, cands);
1737 if (e != nullptr) {
1738 std::vector<NBNode*> cands2(cands);
1739 cands2.push_back(e->getToNode());
1740 if (reduceToCircle(cluster, circleSize, startNodes, maxDist, cands2)) {
1741 return true;
1742 }
1743 }
1744 }
1745#ifdef DEBUG_REDUCE
1746 std::cout << " abort2\n";
1747#endif
1748 return false;
1749}
1750
1751
1752NBEdge*
1753NBNodeCont::shortestEdge(const NodeSet& cluster, const NodeSet& startNodes, const std::vector<NBNode*>& exclude) const {
1754 double minDist = std::numeric_limits<double>::max();
1755 NBEdge* result = nullptr;
1756 for (NBNode* n : startNodes) {
1757 for (NBEdge* e : n->getOutgoingEdges()) {
1758 NBNode* neigh = e->getToNode();
1759 if (cluster.count(neigh) != 0 && std::find(exclude.begin(), exclude.end(), neigh) == exclude.end()) {
1760 const double dist = n->getPosition().distanceTo2D(neigh->getPosition());
1761 //std::cout << " e=" << e->getID() << " dist=" << dist << " minD=" << minDist << "\n";
1762 if (dist < minDist) {
1763 minDist = dist;
1764 result = e;
1765 }
1766 }
1767 }
1768 }
1769 //std::cout << "closestNeighbor startNodes=" << toString(startNodes) << " result=" << Named::getIDSecure(result) << "\n";
1770 return result;
1771}
1772
1773void
1775 NBDistrictCont& dc, NBEdgeCont& ec, NBTrafficLightLogicCont& tlc, bool resetConnections) {
1776 for (NodeSet cluster : clusters) {
1777 joinNodeCluster(cluster, dc, ec, tlc, nullptr, resetConnections);
1778 }
1779}
1780
1781
1782void
1783NBNodeCont::joinNodeCluster(NodeSet cluster, NBDistrictCont& dc, NBEdgeCont& ec, NBTrafficLightLogicCont& tlc, NBNode* predefined, bool resetConnections) {
1784 const bool origNames = OptionsCont::getOptions().getBool("output.original-names");
1785 assert(cluster.size() > 1);
1786 std::string id = "cluster_";
1787 Position pos;
1788 bool setTL = false;
1791 // collect edges
1792 std::set<NBEdge*, ComparatorIdLess> allEdges;
1793 for (NBNode* n : cluster) {
1794 const EdgeVector& edges = n->getEdges();
1795 allEdges.insert(edges.begin(), edges.end());
1796 }
1797 // determine edges with are incoming or fully inside
1798 std::set<NBEdge*, ComparatorIdLess> clusterIncoming;
1799 std::set<NBEdge*, ComparatorIdLess> inside;
1800 for (NBEdge* e : allEdges) {
1801 if (cluster.count(e->getToNode()) > 0) {
1802 if (cluster.count(e->getFromNode()) > 0) {
1803 inside.insert(e);
1804 if (e->getSignalPosition() != Position::INVALID) {
1805 setTL = true;
1807 }
1808 } else {
1809 clusterIncoming.insert(e);
1810 }
1811 }
1812 }
1813#ifdef DEBUG_JOINJUNCTIONS_CONNECTIONS
1814 std::cout << "joining cluster " << joinNamedToString(cluster, ' ')
1815 << " resetConnections=" << resetConnections << "\n"
1816 << " incoming=" << joinNamedToString(clusterIncoming, ' ') << "\n"
1817 << " inside=" << joinNamedToString(inside, ' ') << "\n";
1818#endif
1819 analyzeCluster(cluster, id, pos, setTL, type, nodeType);
1820 NBNode* newNode = nullptr;
1821 if (predefined != nullptr) {
1822 newNode = predefined;
1823 } else {
1824 if (!insert(id, pos)) {
1825 // should not fail
1826 WRITE_WARNINGF(TL("Could not join junctions %."), id);
1827 return;
1828 }
1829 newNode = retrieve(id);
1830 }
1831 std::string tlID = id;
1832 if (predefined != nullptr) {
1833 if (predefined->getType() != SumoXMLNodeType::UNKNOWN) {
1834 nodeType = predefined->getType();
1835 }
1836 Position ppos = predefined->getPosition();
1837 if (ppos.x() != Position::INVALID.x()) {
1838 pos.setx(ppos.x());
1839 }
1840 if (ppos.y() != Position::INVALID.y()) {
1841 pos.sety(ppos.y());
1842 }
1843 if (ppos.z() != Position::INVALID.z()) {
1844 pos.setz(ppos.z());
1845 }
1846 }
1847 newNode->reinit(pos, nodeType);
1848 if (origNames) {
1849 newNode->setParameter(SUMO_PARAM_ORIGID, joinNamedToString(cluster, ' '));
1850 }
1851 if (setTL && !newNode->isTLControlled()) {
1852 NBTrafficLightDefinition* tlDef = new NBOwnTLDef(tlID, newNode, 0, type);
1853 if (!tlc.insert(tlDef)) {
1854 // actually, nothing should fail here
1855 delete tlDef;
1856 throw ProcessError(TLF("Could not allocate tls '%'.", id));
1857 }
1858 }
1859
1860 // determine possible connectivity from outside edges
1861 std::map<NBEdge*, EdgeSet> reachable;
1862 std::map<std::pair<NBEdge*, NBEdge*>, SVCPermissions> conPermissions;
1863 EdgeSet specialPermissions;
1864 for (NBEdge* const e : clusterIncoming) {
1865 EdgeVector open;
1866 EdgeSet seen;
1867 open.push_back(e);
1868 while (open.size() > 0) {
1869 NBEdge* const cur = open.back();
1870 const SVCPermissions pCur = conPermissions.count({e, cur}) == 0 ? cur->getPermissions() : conPermissions[ {e, cur}];
1871#ifdef DEBUG_JOINJUNCTIONS_CONNECTIONS
1872 std::cout << "e=" << e->getID() << " cur=" << cur->getID() << " open=" << toString(open) << "\n";
1873 std::cout << "e=" << e->getID() << " cur=" << cur->getID() << " open=" << toString(open) << "\n";
1874#endif
1875 seen.insert(cur);
1876 open.pop_back();
1877 if (cluster.count(cur->getToNode()) == 0) {
1878 //std::cout << " continue\n";
1879 continue;
1880 }
1881 const auto& cons = cur->getConnections();
1882 if (cons.size() == 0 || ec.hasPostProcessConnection(cur->getID()) || cur->getStep() == NBEdge::EdgeBuildingStep::INIT) {
1883 // check permissions to determine reachability
1884 for (NBEdge* out : cur->getToNode()->getOutgoingEdges()) {
1885 if (allEdges.count(out) != 0) {
1886 const SVCPermissions p = pCur & out->getPermissions();
1887 if (seen.count(out) == 0 || (~conPermissions[ {e, out}] & p) != 0) {
1888 if ((p & ~SVC_PEDESTRIAN) != 0) {
1889 open.push_back(out);
1890 conPermissions[ {e, out}] |= p;
1891#ifdef DEBUG_JOINJUNCTIONS_CONNECTIONS
1892 std::cout << " e=" << e->getID() << " out=" << out->getID() << " pOut=" << getVehicleClassNames(out->getPermissions()) << "\n p=" << getVehicleClassNames(p) << "\n q=" << getVehicleClassNames(conPermissions[ {e, out}]) << "\n";
1893#endif
1894 }
1895 }
1896 }
1897 }
1898 } else {
1899 // check existing connections
1900 for (const auto& con : cons) {
1901 if (con.toEdge != nullptr && allEdges.count(con.toEdge) != 0) {
1902 SVCPermissions p = pCur & con.toEdge->getPermissions();
1903 if (con.permissions != SVC_UNSPECIFIED) {
1904 p &= con.permissions;
1905 }
1906 if (seen.count(con.toEdge) == 0 || (~conPermissions[ {e, con.toEdge}] & p) != 0) {
1907 open.push_back(con.toEdge);
1908 conPermissions[ {e, con.toEdge}] |= p;
1909 //std::cout << " e=" << e->getID() << " con.toEdge=" << con.toEdge->getID() << " pSpecial=" << toString(con.permissions) << " pOut=" << getVehicleClassNames(con.toEdge->getPermissions()) << "\n p=" << getVehicleClassNames(p) << "\n q=" << getVehicleClassNames(conPermissions[{e, con.toEdge}]) << "\n";
1910 }
1911 }
1912 }
1913 }
1914 }
1915 seen.erase(e);
1916 for (NBEdge* reached : seen) {
1917 // filter out inside edges from reached
1918 if (inside.count(reached) == 0) {
1919 if (e->getStep() > NBEdge::EdgeBuildingStep::INIT && reached->getFromNode() == e->getToNode() && !e->isConnectedTo(reached)) {
1920 // also filter out edges that are outgoing of the to-node of edge but aren't currently connected
1921 continue;
1922 }
1923 reachable[e].insert(reached);
1924 const SVCPermissions pDefault = e->getPermissions() & reached->getPermissions();
1925 if (conPermissions[ {e, reached}] != pDefault) {
1926 specialPermissions.insert(e);
1927#ifdef DEBUG_JOINJUNCTIONS_CONNECTIONS
1928 std::cout << "e=" << e->getID() << " out=" << reached->getID() << " special=" << getVehicleClassNames(conPermissions[ {e, reached}]) << "\n";
1929#endif
1930 }
1931 }
1932 }
1933#ifdef DEBUG_JOINJUNCTIONS_CONNECTIONS
1934 std::cout << " reachable e=" << e->getID() << " seen=" << toString(seen) << " reachable=" << toString(reachable[e]) << "\n";
1935#endif
1936 }
1937
1938 // remap and remove edges which are completely within the new intersection
1939 if (origNames) {
1940 newNode->setParameter("origEdgeIds", joinNamedToString(inside, ' '));
1941 }
1942 for (NBEdge* e : inside) {
1943 for (NBEdge* e2 : allEdges) {
1944 if (e != e2) {
1945 e2->replaceInConnections(e, e->getConnections());
1946 }
1947 }
1948 ec.extract(dc, e, true);
1949 allEdges.erase(e);
1950 }
1951
1952 // remap edges which are incoming / outgoing
1953 for (NBEdge* e : allEdges) {
1954 const bool outgoing = cluster.count(e->getFromNode()) > 0;
1955 NBNode* from = outgoing ? newNode : e->getFromNode();
1956 NBNode* to = outgoing ? e->getToNode() : newNode;
1957 if (origNames) {
1958 if (outgoing) {
1959 e->setParameter("origFrom", e->getFromNode()->getID());
1960 } else {
1961 e->setParameter("origTo", e->getToNode()->getID());
1962 }
1963 }
1964 if (e->getTurnSignTarget() != "") {
1965 for (NBNode* n : cluster) {
1966 if (e->getTurnSignTarget() == n->getID()) {
1967 e->setTurnSignTarget(to->getID());
1968 break;
1969 }
1970 }
1971 }
1972 e->reinitNodes(from, to);
1973 // re-add connections which previously existed and may still valid.
1974 // connections to removed edges will be ignored
1975 std::vector<NBEdge::Connection> conns = e->getConnections();
1976 for (std::vector<NBEdge::Connection>::iterator k = conns.begin(); k != conns.end(); ++k) {
1977 if ((*k).toEdge == nullptr) {
1978 // edge explicitly set to have no connections
1979 continue;
1980 }
1981 e->addLane2LaneConnection((*k).fromLane, (*k).toEdge, (*k).toLane, NBEdge::Lane2LaneInfoType::USER, false, (*k).mayDefinitelyPass);
1982 if ((*k).fromLane >= 0 && (*k).fromLane < e->getNumLanes() && e->getLaneStruct((*k).fromLane).connectionsDone) {
1983 // @note (see NIImporter_DlrNavteq::ConnectedLanesHandler)
1984 e->declareConnectionsAsLoaded(NBEdge::EdgeBuildingStep::INIT);
1985#ifdef DEBUG_JOINJUNCTIONS_CONNECTIONS
1986 std::cout << " e=" << e->getID() << " declareConnectionsAsLoaded\n";
1987#endif
1988 }
1989 }
1990 }
1991 if (!resetConnections) {
1992 // disable connections that were impossible with the old topology
1993 // if connectivity has special permissions, set edge to edge connections explicitly
1994 for (NBEdge* in : newNode->getIncomingEdges()) {
1995 for (NBEdge* out : newNode->getOutgoingEdges()) {
1996 if (reachable[in].count(out) == 0) {
1997 if (!ec.hasPostProcessConnection(in->getID(), out->getID())) {
1998 //std::cout << " removeUnreachable in=" << in->getID() << " out=" << out->getID() << "\n";
1999 in->removeFromConnections(out, -1, -1, true, false, true);
2000 } else {
2001 //std::cout << " hasPostProcessConnection in=" << in->getID() << " out=" << out->getID() << "\n";
2002 }
2003 } else if (specialPermissions.count(in) != 0) {
2004 SVCPermissions pDefault = in->getPermissions() & out->getPermissions();
2005 SVCPermissions p = conPermissions[ {in, out}] == 0 ? pDefault : conPermissions[ {in, out}];
2006 in->addEdge2EdgeConnection(out, true, p == pDefault ? SVC_UNSPECIFIED : p);
2007 //std::cout << " addEdge2Edge in=" << in->getID() << " out=" << out->getID() << "\n";
2008 }
2009 }
2010 }
2011 } else {
2012 for (NBEdge* in : newNode->getIncomingEdges()) {
2013 in->invalidateConnections(true);
2014 }
2015 }
2016
2017 // remove original nodes
2018 registerJoinedCluster(cluster);
2019 for (NBNode* n : cluster) {
2020 erase(n);
2021 }
2022}
2023
2024
2025void
2027 std::set<std::string> ids;
2028 for (NBNode* n : cluster) {
2029 ids.insert(n->getID());
2030 }
2031 myJoinedClusters.push_back(ids);
2032}
2033
2034void
2035NBNodeCont::registerJoinedCluster(const std::set<std::string>& cluster) {
2036 myJoinedClusters.push_back(cluster);
2037}
2038
2039void
2040NBNodeCont::unregisterJoinedCluster(const std::set<std::string>& cluster) {
2041 auto it = std::find(myJoinedClusters.begin(), myJoinedClusters.end(), cluster);
2042 if (it != myJoinedClusters.end()) {
2043 myJoinedClusters.erase(it);
2044 }
2045}
2046
2047
2048void
2049NBNodeCont::analyzeCluster(NodeSet cluster, std::string& id, Position& pos,
2050 bool& hasTLS, TrafficLightType& type, SumoXMLNodeType& nodeType) {
2051 id = createClusterId(cluster, id);
2052 bool ambiguousType = false;
2053 for (NBNode* j : cluster) {
2054 pos.add(j->getPosition());
2055 // add a traffic light if any of the cluster members was controlled
2056 if (j->isTLControlled()) {
2057 if (!hasTLS) {
2058 // init type
2059 type = (*j->getControllingTLS().begin())->getType();
2060 } else if (type != (*j->getControllingTLS().begin())->getType()) {
2061 ambiguousType = true;
2062 }
2063 hasTLS = true;
2064 }
2065 SumoXMLNodeType otherType = j->getType();
2066 if (nodeType == SumoXMLNodeType::UNKNOWN) {
2067 nodeType = otherType;
2068 } else if (nodeType != otherType) {
2069 if (hasTLS) {
2071 } else if (otherType != SumoXMLNodeType::UNKNOWN) {
2072 if ((nodeType != SumoXMLNodeType::PRIORITY && (nodeType != SumoXMLNodeType::NOJUNCTION || otherType != SumoXMLNodeType::PRIORITY))
2073 || (otherType != SumoXMLNodeType::NOJUNCTION && otherType != SumoXMLNodeType::UNKNOWN && otherType != SumoXMLNodeType::PRIORITY)) {
2074 WRITE_WARNINGF("Ambiguous node type for node cluster '%' (%,%), setting to '" + toString(SumoXMLNodeType::PRIORITY) + "'.", id, toString(nodeType), toString(otherType));
2075 }
2076 nodeType = SumoXMLNodeType::PRIORITY;
2077 }
2078 }
2079 }
2080 pos.mul(1. / (double)cluster.size());
2081 if (ambiguousType) {
2082 type = SUMOXMLDefinitions::TrafficLightTypes.get(OptionsCont::getOptions().getString("tls.default-type"));
2083 WRITE_WARNINGF(TL("Ambiguous traffic light type for node cluster '%', setting to '%'."), id, toString(type));
2084 }
2085}
2086
2087
2088// ----------- (Helper) methods for guessing/computing traffic lights
2089bool
2090NBNodeCont::shouldBeTLSControlled(const NodeSet& c, double laneSpeedThreshold, bool recheck) const {
2091 bool tooFast = false;
2092 double laneSpeedSum = 0;
2093 std::set<NBEdge*> seen;
2094 for (NBNode* j : c) {
2095 for (const NBEdge* e : j->getEdges()) {
2096 if (c.find(e->getFromNode()) != c.end() && c.find(e->getToNode()) != c.end()) {
2097 // edges fully within the cluster do not count
2098 continue;
2099 }
2100 if (j->hasIncoming(e)) {
2101 if (recheck && !j->hasConflict(e)) {
2102 // edges without conflict do not count
2103 // we can only check this after connections have been computed
2104 continue;
2105 }
2106 laneSpeedSum += (double)e->getNumLanes() * e->getLaneSpeed(0);
2107 }
2108 if (e->getLaneSpeed(0) * 3.6 > 79) {
2109 tooFast = true;
2110 }
2111 }
2112 }
2113 //std::cout << " c=" << joinNamedToString(c, ' ') << " size=" << c.size() << " laneSpeedSum=" << laneSpeedSum << " thresh=" << laneSpeedThreshold << " tooFast=" << tooFast << "\n";
2114 return !tooFast && laneSpeedSum >= laneSpeedThreshold && c.size() != 0;
2115}
2116
2117bool
2119 // check whether all component nodes are solely pedestrian crossings
2120 // (these work fine without joining)
2121 for (NBNode* node : c) {
2122 EdgeVector nonPedIncoming;
2123 EdgeVector nonPedOutgoing;
2124 for (NBEdge* e : node->getIncomingEdges()) {
2125 if (e->getPermissions() != SVC_PEDESTRIAN) {
2126 nonPedIncoming.push_back(e);
2127 }
2128 }
2129 for (NBEdge* e : node->getOutgoingEdges()) {
2130 if (e->getPermissions() != SVC_PEDESTRIAN) {
2131 nonPedOutgoing.push_back(e);
2132 }
2133 }
2134 if (!node->geometryLike(nonPedIncoming, nonPedOutgoing)) {
2135 //for (NBNode* node : c) {
2136 // if (node->getID() == "2480337678") {
2137 // std::cout << " node=" << node->getID() << " nonPedIncoming=" << toString(nonPedIncoming) << " nonPedOutgoing=" << toString(nonPedOutgoing) << "\n";
2138 // }
2139 //}
2140 return false;
2141 }
2142 }
2143 return true;
2144}
2145
2146
2147bool
2149 for (NBNode* node : c) {
2150 if (node->isTLControlled()) {
2151 NBTrafficLightDefinition* tl = (*node->getControllingTLS().begin());
2152 if (tl->getNodes().size() > 1) {
2153 // joined tls also imply a customID
2154 return true;
2155 }
2156 const std::string tlID = tl->getID();
2157 if (tlID != node->getID()
2158 && !StringUtils::startsWith(tlID, "joinedS_")
2159 && !StringUtils::startsWith(tlID, "joinedG_")
2160 && !StringUtils::startsWith(tlID, "GS")) {
2161 return true;
2162 }
2163 }
2164 }
2165 return false;
2166}
2167
2168
2169void
2171 myGuessedTLS.clear();
2172 // build list of definitely not tls-controlled junctions
2173 const double laneSpeedThreshold = oc.getFloat("tls.guess.threshold");
2174 if (oc.isSet("tls.unset")) {
2175 std::vector<std::string> notTLControlledNodes = oc.getStringVector("tls.unset");
2176 for (std::vector<std::string>::const_iterator i = notTLControlledNodes.begin(); i != notTLControlledNodes.end(); ++i) {
2178 if (n == nullptr) {
2179 throw ProcessError(TLF(" The junction '%' to set as not-controlled is not known.", *i));
2180 }
2181 std::set<NBTrafficLightDefinition*> tls = n->getControllingTLS();
2182 for (std::set<NBTrafficLightDefinition*>::const_iterator j = tls.begin(); j != tls.end(); ++j) {
2183 (*j)->removeNode(n);
2184 }
2186 myUnsetTLS.insert(n);
2187 }
2188 }
2189
2191 // loop#1 checking whether the node shall be tls controlled,
2192 // because it is assigned to a district
2193 if (oc.exists("tls.taz-nodes") && oc.getBool("tls.taz-nodes")) {
2194 for (NodeCont::iterator i = myNodes.begin(); i != myNodes.end(); i++) {
2195 NBNode* cur = (*i).second;
2196 if (cur->isNearDistrict() && myUnsetTLS.count(cur) == 0) {
2197 setAsTLControlled(cur, tlc, type);
2198 }
2199 }
2200 }
2201
2202 // figure out which nodes mark the locations of TLS signals
2203 // This assumes nodes are already joined
2204 if (oc.exists("tls.guess-signals") && oc.getBool("tls.guess-signals")) {
2205 // prepare candidate edges
2206 const double signalDist = oc.getFloat("tls.guess-signals.dist");
2207 for (const auto& item : myNodes) {
2208 const NBNode* node = item.second;
2209 if (node->isTLControlled() && (node->getIncomingEdges().size() == 1 || node->geometryLike())) {
2210#ifdef DEBUG_GUESSSIGNALS
2211 if (DEBUGCOND(node) || true) {
2212 std::cout << " propagate TLS from " << node->getID() << " downstream\n";
2213 }
2214#endif
2215 for (NBEdge* edge : node->getOutgoingEdges()) {
2216 // do not overwrite closer signals
2217 if (edge->getSignalOffset() == NBEdge::UNSPECIFIED_SIGNAL_OFFSET) {
2218 edge->setSignalPosition(node->getPosition(), node);
2219 }
2220 }
2221 }
2222 }
2223 std::set<NBEdge*> seen;
2224 std::set<NBEdge*> check;
2225 for (const auto& item : myNodes) {
2226 for (NBEdge* edge : item.second->getOutgoingEdges()) {
2227 if (edge->getSignalPosition() != Position::INVALID) {
2228 check.insert(edge);
2229 seen.insert(edge);
2230#ifdef DEBUG_GUESSSIGNALS
2231 if (DEBUGCOND(edge->getSignalNode()) || true) {
2232 std::cout << " primary signalPosition edge=" << edge->getID() << " pos=" << edge->getSignalPosition() << "\n";
2233 }
2234#endif
2235 }
2236 }
2237 }
2238 // propagate signal position until the next real intersection
2239 while (check.size() > 0) {
2240 NBEdge* const edge = *check.begin();
2241 check.erase(check.begin());
2242 seen.insert(edge);
2243 NBNode* const nextNode = edge->getToNode();
2244 if (nextNode->geometryLike() && !nextNode->isTLControlled()) {
2245 for (NBEdge* const outEdge : nextNode->getOutgoingEdges()) {
2246 if (seen.count(outEdge) == 0) {
2247 outEdge->setSignalPosition(edge->getSignalPosition(), edge->getSignalNode());
2248#ifdef DEBUG_GUESSSIGNALS
2249 if (DEBUGCOND(edge->getSignalNode()) || true) {
2250 std::cout << " setSignalPosition edge=" << outEdge->getID() << " pos=" << edge->getSignalPosition() << "\n";
2251 }
2252#endif
2253 check.insert(outEdge);
2254 }
2255 }
2256 }
2257 }
2258
2259 // check which nodes should be controlled
2260 const int slack = oc.getInt("tls.guess-signals.slack");
2261 for (std::map<std::string, NBNode*>::const_iterator i = myNodes.begin(); i != myNodes.end(); ++i) {
2262 NBNode* node = i->second;
2263 if (myUnsetTLS.count(node) != 0) {
2264 continue;
2265 }
2266 const EdgeVector& incoming = node->getIncomingEdges();
2267 const EdgeVector& outgoing = node->getOutgoingEdges();
2268 if (!node->isTLControlled() && incoming.size() > 1 && !node->geometryLike()
2271 std::vector<const NBNode*> signals;
2272 int foundSignals = 0;
2273 int missingSignals = 0;
2274 // check if there is a signal at every incoming edge
2275 for (EdgeVector::const_iterator it_i = incoming.begin(); it_i != incoming.end(); ++it_i) {
2276 const NBEdge* inEdge = *it_i;
2278 if ((inEdge->getPermissions() & SVC_PASSENGER) != 0) {
2279#ifdef DEBUG_GUESSSIGNALS
2280 if (DEBUGCOND(node)) {
2281 std::cout << " noTLS, edge=" << inEdge->getID() << "\n";
2282 }
2283#endif
2284 missingSignals++;
2285 if (missingSignals > slack) {
2286 break;
2287 }
2288 }
2289 } else {
2290 foundSignals++;
2291 }
2292 }
2293 missingSignals = 0;
2294 int foundSignalsAtDist = 0;
2295 if (foundSignals > 1 && missingSignals <= slack && missingSignals < foundSignals) {
2297 // check if all signals are within the required distance
2298 // (requires detailed geometry computation)
2299 for (EdgeVector::const_iterator it_i = incoming.begin(); it_i != incoming.end(); ++it_i) {
2300 const NBEdge* inEdge = *it_i;
2301 if (inEdge->getSignalOffset() == NBEdge::UNSPECIFIED_SIGNAL_OFFSET || inEdge->getSignalOffset() > signalDist) {
2302 if ((inEdge->getPermissions() & SVC_PASSENGER) != 0) {
2303#ifdef DEBUG_GUESSSIGNALS
2304 if (DEBUGCOND(node)) {
2305 std::cout << " noTLS, edge=" << inEdge->getID() << " offset=" << inEdge->getSignalOffset() << " tlsPos=" << inEdge->getSignalPosition() << "\n";
2306 }
2307#endif
2308 missingSignals++;
2309 if (missingSignals > slack) {
2310 break;
2311 }
2312 }
2313 } else {
2314 foundSignalsAtDist++;
2315 }
2316 const NBNode* signal = inEdge->getSignalNode();
2317 if (signal != nullptr) {
2318 signals.push_back(signal);
2319 }
2320 }
2321 // outgoing edges may be tagged with pedestrian crossings. These
2322 // should also be merged into the main TLS
2323 for (const NBEdge* outEdge : outgoing) {
2324 NBNode* cand = outEdge->getToNode();
2325 if (cand->isTLControlled() && cand->geometryLike() && outEdge->getLength() <= signalDist) {
2326#ifdef DEBUG_GUESSSIGNALS
2327 if (DEBUGCOND(node)) {
2328 std::cout << " node=" << node->getID() << " outEdge=" << outEdge->getID() << " signalNode=" << cand->getID() << " len=" << outEdge->getLength() << "\n";
2329 }
2330#endif
2331 signals.push_back(cand);
2332 }
2333 }
2334 }
2335 if (foundSignalsAtDist > 1 && missingSignals <= slack && missingSignals < foundSignalsAtDist) {
2336 for (const NBNode* s : signals) {
2337 std::set<NBTrafficLightDefinition*> tls = s->getControllingTLS();
2338 const_cast<NBNode*>(s)->reinit(s->getPosition(), SumoXMLNodeType::PRIORITY);
2339 for (std::set<NBTrafficLightDefinition*>::iterator k = tls.begin(); k != tls.end(); ++k) {
2340 tlc.removeFully(s->getID());
2341 }
2342 }
2343 //if (true) std::cout << " node=" << node->getID() << " signals=" << toString(signals) << "\n";
2344 NBTrafficLightDefinition* tlDef = new NBOwnTLDef("GS_" + node->getID(), node, 0, type);
2345 // @todo patch endOffset for all incoming lanes according to the signal positions
2346 if (!tlc.insert(tlDef)) {
2347 // actually, nothing should fail here
2348 WRITE_WARNINGF(TL("Could not build joined tls '%'."), node->getID());
2349 delete tlDef;
2350 return;
2351 }
2352 }
2353 }
2354 }
2355 }
2356
2357 // guess joined tls first, if wished
2358 if (oc.getBool("tls.guess.joining")) {
2359 // get node clusters
2360 NodeClusters cands;
2361 generateNodeClusters(oc.getFloat("tls.join-dist"), cands);
2362 // check these candidates (clusters) whether they should be controlled by a tls
2363 for (NodeClusters::iterator i = cands.begin(); i != cands.end();) {
2364 NodeSet& c = (*i);
2365 // regard only junctions which are not yet controlled and are not
2366 // forbidden to be controlled
2367 for (NodeSet::iterator j = c.begin(); j != c.end();) {
2368 if ((*j)->isTLControlled() || myUnsetTLS.count(*j) != 0) {
2369 c.erase(j++);
2370 } else {
2371 ++j;
2372 }
2373 }
2374 // check whether the cluster should be controlled
2375 // to avoid gigantic clusters, assume that at most 4 nodes should be needed for a guessed-joined-tls
2376 if (c.size() == 0 || !shouldBeTLSControlled(c, laneSpeedThreshold * (double)c.size() / MIN2((double)c.size(), 4.))) {
2377 i = cands.erase(i);
2378 } else {
2379 ++i;
2380 }
2381 }
2382 // cands now only contain sets of junctions that shall be joined into being tls-controlled
2383 for (auto nodeSet : cands) {
2384 std::vector<NBNode*> nodes;
2385 for (NBNode* node : nodeSet) {
2386 nodes.push_back(node);
2387 myGuessedTLS.insert(node);
2388 }
2389 const std::string& id = createClusterId(nodeSet, "joinedG_");
2390 NBTrafficLightDefinition* tlDef = new NBOwnTLDef(id, nodes, 0, type);
2391 if (!tlc.insert(tlDef)) {
2392 // actually, nothing should fail here
2393 WRITE_WARNING(TL("Could not build guessed, joined tls."));
2394 delete tlDef;
2395 return;
2396 }
2397 }
2398 }
2399
2400 // guess single tls
2401 if (oc.getBool("tls.guess")) {
2402 for (NodeCont::iterator i = myNodes.begin(); i != myNodes.end(); i++) {
2403 NBNode* cur = (*i).second;
2404 // do nothing if already is tl-controlled
2405 if (cur->isTLControlled()) {
2406 continue;
2407 }
2408 // do nothing if in the list of explicit non-controlled junctions
2409 if (myUnsetTLS.count(cur) != 0) {
2410 continue;
2411 }
2412 NodeSet c;
2413 c.insert(cur);
2414 if (!shouldBeTLSControlled(c, laneSpeedThreshold) || cur->geometryLike()) {
2415 continue;
2416 }
2417 setAsTLControlled(cur, tlc, type);
2418 myGuessedTLS.insert(cur);
2419 }
2420 }
2421}
2422
2423
2424void
2426 std::set<NBTrafficLightDefinition*> recompute;
2427 for (NBNode* node : myGuessedTLS) {
2428 if (!node->hasConflict() || !recheckTLSThreshold(node)) {
2429 const std::set<NBTrafficLightDefinition*>& tlDefs = node->getControllingTLS();
2430 recompute.insert(tlDefs.begin(), tlDefs.end());
2431 node->removeTrafficLights(true);
2432 for (NBEdge* edge : node->getIncomingEdges()) {
2433 edge->clearControllingTLInformation();
2434 }
2435 }
2436 }
2437 for (NBTrafficLightDefinition* def : recompute) {
2438 if (def->getNodes().size() == 0) {
2439 tlc.removeFully(def->getID());
2440 } else {
2441 def->setParticipantsInformation();
2442 def->setTLControllingInformation();
2444 }
2445 }
2446}
2447
2448
2449bool
2451 if (!node->isTLControlled()) {
2452 return false;
2453 }
2454 if ((*node->getControllingTLS().begin())->getNodes().size() != 1) {
2455 // unable to perform check for a joined tls
2456 return true;
2457 }
2458 NodeSet c;
2459 c.insert(node);
2460 const double laneSpeedThreshold = OptionsCont::getOptions().getFloat("tls.guess.threshold");
2461 return shouldBeTLSControlled(c, laneSpeedThreshold, true);
2462}
2463
2464
2465void
2467 for (const auto& item : myNodes) {
2468 item.second->computeKeepClear();
2469 }
2470}
2471
2472
2473void
2475 const std::vector<std::string> excludeList = OptionsCont::getOptions().getStringVector("tls.join-exclude");
2476 for (const std::string& tlsID : excludeList) {
2477 if (!tlc.exist(tlsID, false)) {
2478 WRITE_WARNINGF("Unknown tls ID '%' in option tls.join-exclude", tlsID);
2479 }
2480 }
2481 std::set<std::string> exclude(excludeList.begin(), excludeList.end());
2482 NodeClusters cands;
2483 generateNodeClusters(maxdist, cands);
2484 for (NodeSet& c : cands) {
2485 for (NodeSet::iterator j = c.begin(); j != c.end();) {
2486 if (!(*j)->isTLControlled() || exclude.count((*(*j)->getControllingTLS().begin())->getID()) != 0) {
2487 c.erase(j++);
2488 } else {
2489 ++j;
2490 }
2491 }
2492 if (c.size() < 2 || onlyCrossings(c) || customTLID(c)) {
2493 continue;
2494 }
2495 // figure out type of the joined TLS
2496 Position dummyPos;
2497 bool dummySetTL = false;
2498 std::string id = "joinedS_"; // prefix (see #3871)
2499 TrafficLightType type;
2501 analyzeCluster(c, id, dummyPos, dummySetTL, type, nodeType);
2502 for (NBNode* j : c) {
2503 std::set<NBTrafficLightDefinition*> tls = j->getControllingTLS();
2504 j->removeTrafficLights();
2505 for (NBTrafficLightDefinition* k : tls) {
2506 tlc.removeFully(k->getID());
2507 }
2508 }
2509 std::vector<NBNode*> nodes;
2510 for (NBNode* j : c) {
2511 nodes.push_back(j);
2512 }
2513 NBTrafficLightDefinition* tlDef = new NBOwnTLDef(id, nodes, 0, type);
2514 if (!tlc.insert(tlDef)) {
2515 // actually, nothing should fail here
2516 WRITE_WARNING(TL("Could not build a joined tls."));
2517 delete tlDef;
2518 return;
2519 }
2520 }
2521}
2522
2523
2524void
2526 TrafficLightType type, std::string id) {
2527 if (id == "") {
2528 id = node->getID();
2529 }
2530 NBTrafficLightDefinition* tlDef = new NBOwnTLDef(id, node, 0, type);
2531 if (!tlc.insert(tlDef)) {
2532 // actually, nothing should fail here
2533 WRITE_WARNINGF(TL("Building a tl-logic for junction '%' twice is not possible."), id);
2534 delete tlDef;
2535 return;
2536 }
2537}
2538
2539
2540// -----------
2541void
2543 for (NodeCont::iterator i = myNodes.begin(); i != myNodes.end(); i++) {
2544 (*i).second->computeLanes2Lanes();
2545 }
2546}
2547
2548
2549// computes the "wheel" of incoming and outgoing edges for every node
2550void
2552 for (NodeCont::iterator i = myNodes.begin(); i != myNodes.end(); i++) {
2553 (*i).second->computeLogic(ec);
2554 }
2555}
2556
2557
2558void
2560 std::set<NBNode*> roundaboutNodes;
2561 const bool checkLaneFoesAll = oc.getBool("check-lane-foes.all");
2562 const bool checkLaneFoesRoundabout = !checkLaneFoesAll && oc.getBool("check-lane-foes.roundabout");
2563 if (checkLaneFoesRoundabout) {
2564 const std::set<EdgeSet>& roundabouts = ec.getRoundabouts();
2565 for (std::set<EdgeSet>::const_iterator i = roundabouts.begin(); i != roundabouts.end(); ++i) {
2566 for (EdgeSet::const_iterator j = (*i).begin(); j != (*i).end(); ++j) {
2567 roundaboutNodes.insert((*j)->getToNode());
2568 }
2569 }
2570 }
2571 for (NodeCont::iterator i = myNodes.begin(); i != myNodes.end(); i++) {
2572 const bool checkLaneFoes = checkLaneFoesAll || (checkLaneFoesRoundabout && roundaboutNodes.count((*i).second) > 0);
2573 (*i).second->computeLogic2(checkLaneFoes);
2574 }
2575}
2576
2577
2578void
2580 for (NodeCont::iterator i = myNodes.begin(); i != myNodes.end(); i++) {
2581 delete ((*i).second);
2582 }
2583 myNodes.clear();
2584 for (auto& item : myExtractedNodes) {
2585 delete item.second;
2586 }
2587 myExtractedNodes.clear();
2588}
2589
2590
2591std::string
2593 int counter = 0;
2594 std::string freeID = "SUMOGenerated" + toString<int>(counter);
2595 // While there is a node with id equal to freeID
2596 while (retrieve(freeID) != nullptr) {
2597 // update counter and generate a new freeID
2598 counter++;
2599 freeID = "SUMOGenerated" + toString<int>(counter);
2600 }
2601 return freeID;
2602}
2603
2604
2605void
2606NBNodeCont::computeNodeShapes(double mismatchThreshold) {
2607 for (NodeCont::iterator i = myNodes.begin(); i != myNodes.end(); i++) {
2608 (*i).second->computeNodeShape(mismatchThreshold);
2609 }
2610}
2611
2612
2613void
2615 WRITE_MESSAGE(TL("-----------------------------------------------------"));
2616 WRITE_MESSAGE(TL("Summary:"));
2617
2618 int numUnregulatedJunctions = 0;
2619 int numDeadEndJunctions = 0;
2620 int numTrafficLightJunctions = 0;
2621 int numPriorityJunctions = 0;
2622 int numRightBeforeLeftJunctions = 0;
2623 int numLeftBeforeRightJunctions = 0;
2624 int numAllWayStopJunctions = 0;
2625 int numZipperJunctions = 0;
2626 int numDistrictJunctions = 0;
2627 int numRailCrossing = 0;
2628 int numRailSignals = 0;
2629 for (NodeCont::const_iterator i = myNodes.begin(); i != myNodes.end(); i++) {
2630 switch ((*i).second->getType()) {
2632 ++numUnregulatedJunctions;
2633 break;
2635 ++numDeadEndJunctions;
2636 break;
2640 ++numTrafficLightJunctions;
2641 break;
2644 ++numPriorityJunctions;
2645 break;
2647 ++numRightBeforeLeftJunctions;
2648 break;
2650 ++numLeftBeforeRightJunctions;
2651 break;
2653 ++numAllWayStopJunctions;
2654 break;
2656 ++numZipperJunctions;
2657 break;
2659 ++numDistrictJunctions;
2660 break;
2662 ++numRailCrossing;
2663 break;
2665 ++numRailSignals;
2666 break;
2668 // should not happen
2669 break;
2670 default:
2671 break;
2672 }
2673 }
2674 WRITE_MESSAGE(TL(" Node type statistics:"));
2675 WRITE_MESSAGE(" Unregulated junctions : " + toString(numUnregulatedJunctions));
2676 if (numDeadEndJunctions > 0) {
2677 WRITE_MESSAGE(" Dead-end junctions : " + toString(numDeadEndJunctions));
2678 }
2679 WRITE_MESSAGE(" Priority junctions : " + toString(numPriorityJunctions));
2680 WRITE_MESSAGE(" Right-before-left junctions : " + toString(numRightBeforeLeftJunctions));
2681 if (numLeftBeforeRightJunctions > 0) {
2682 WRITE_MESSAGE(" Left-before-right junctions : " + toString(numLeftBeforeRightJunctions));
2683 }
2684 if (numTrafficLightJunctions > 0) {
2685 WRITE_MESSAGE(" Traffic light junctions : " + toString(numTrafficLightJunctions));
2686 }
2687 if (numAllWayStopJunctions > 0) {
2688 WRITE_MESSAGE(" All-way stop junctions : " + toString(numAllWayStopJunctions));
2689 }
2690 if (numZipperJunctions > 0) {
2691 WRITE_MESSAGE(" Zipper-merge junctions : " + toString(numZipperJunctions));
2692 }
2693 if (numRailCrossing > 0) {
2694 WRITE_MESSAGE(" Rail crossing junctions : " + toString(numRailCrossing));
2695 }
2696 if (numRailSignals > 0) {
2697 WRITE_MESSAGE(" Rail signal junctions : " + toString(numRailSignals));
2698 }
2699 if (numDistrictJunctions > 0) {
2700 WRITE_MESSAGE(" District junctions : " + toString(numDistrictJunctions));
2701 }
2702 const GeoConvHelper& geoConvHelper = GeoConvHelper::getProcessing();
2703 WRITE_MESSAGE(TL(" Network boundaries:"));
2704 WRITE_MESSAGE(" Original boundary : " + toString(geoConvHelper.getOrigBoundary()));
2705 WRITE_MESSAGE(" Applied offset : " + toString(geoConvHelper.getOffsetBase()));
2706 WRITE_MESSAGE(" Converted boundary : " + toString(geoConvHelper.getConvBoundary()));
2707 WRITE_MESSAGE(TL("-----------------------------------------------------"));
2708}
2709
2710
2711std::vector<std::string>
2713 std::vector<std::string> ret;
2714 for (NodeCont::const_iterator i = myNodes.begin(); i != myNodes.end(); ++i) {
2715 ret.push_back((*i).first);
2716 }
2717 return ret;
2718}
2719
2720
2721void
2722NBNodeCont::addPrefix(const std::string& prefix) {
2723 // make a copy of node containers
2724 const auto nodeContainerCopy = myNodes;
2725 myNodes.clear();
2726 for (const auto& node : nodeContainerCopy) {
2727 node.second->setID(prefix + node.second->getID());
2728 myNodes[node.second->getID()] = node.second;
2729 }
2730}
2731
2732
2733void
2734NBNodeCont::rename(NBNode* node, const std::string& newID) {
2735 if (myNodes.count(newID) != 0) {
2736 throw ProcessError(TLF("Attempt to rename node using existing id '%'", newID));
2737 }
2738 myNodes.erase(node->getID());
2739 node->setID(newID);
2740 myNodes[newID] = node;
2741}
2742
2743
2744void
2746 for (NodeCont::const_iterator i = myNodes.begin(); i != myNodes.end(); ++i) {
2747 NBNode* node = i->second;
2748 if (node->isTLControlled() && (!geometryLike || node->geometryLike())) {
2749 // make a copy of tldefs
2750 const std::set<NBTrafficLightDefinition*> tldefs = node->getControllingTLS();
2751 if (geometryLike && (*tldefs.begin())->getNodes().size() > 1) {
2752 // do not remove joined tls when only removing geometry-like tls
2753 continue;
2754 }
2755 if (node->getCrossings().size() > 0) {
2756 // keep controlled pedestrian crossings
2757 continue;
2758 }
2759 // record signal location
2760 for (NBEdge* edge : node->getOutgoingEdges()) {
2761 edge->setSignalPosition(node->getPosition(), nullptr);
2762#ifdef DEBUG_GUESSSIGNALS
2763 std::cout << " discard-simple " << node->getID() << " edge=" << edge->getID() << " pos=" << edge->getSignalPosition() << "\n";
2764#endif
2765 }
2766 for (std::set<NBTrafficLightDefinition*>::const_iterator it = tldefs.begin(); it != tldefs.end(); ++it) {
2767 NBTrafficLightDefinition* tlDef = *it;
2768 node->removeTrafficLight(tlDef);
2769 tlc.extract(tlDef);
2770 }
2772 node->reinit(node->getPosition(), newType);
2773 }
2774 }
2775}
2776
2777
2778void
2780 for (auto& item : myNodes) {
2781 NBNode* node = item.second;
2782 if (node->getType() == SumoXMLNodeType::RAIL_SIGNAL) {
2784 }
2785 }
2786}
2787
2788
2789int
2790NBNodeCont::remapIDs(bool numericaIDs, bool reservedIDs, const std::string& prefix, NBTrafficLightLogicCont& tlc) {
2791 bool startGiven = !OptionsCont::getOptions().isDefault("numerical-ids.node-start");
2792 if (!numericaIDs && !reservedIDs && prefix == "" && !startGiven) {
2793 return 0;
2794 }
2795 std::vector<std::string> avoid;
2796 if (startGiven) {
2797 avoid.push_back(toString(OptionsCont::getOptions().getInt("numerical-ids.node-start") - 1));
2798 } else {
2799 avoid = getAllNames();
2800 }
2801 std::set<std::string> reserve;
2802 if (reservedIDs) {
2803 NBHelpers::loadPrefixedIDsFomFile(OptionsCont::getOptions().getString("reserved-ids"), "node:", reserve); // backward compatibility
2804 NBHelpers::loadPrefixedIDsFomFile(OptionsCont::getOptions().getString("reserved-ids"), "junction:", reserve); // selection format
2805 avoid.insert(avoid.end(), reserve.begin(), reserve.end());
2806 }
2807 IDSupplier idSupplier("", avoid);
2808 NodeSet toChange;
2809 for (NodeCont::iterator it = myNodes.begin(); it != myNodes.end(); it++) {
2810 if (startGiven) {
2811 toChange.insert(it->second);
2812 continue;
2813 }
2814 if (numericaIDs) {
2815 try {
2816 StringUtils::toLong(it->first);
2817 } catch (NumberFormatException&) {
2818 toChange.insert(it->second);
2819 }
2820 }
2821 if (reservedIDs && reserve.count(it->first) > 0) {
2822 toChange.insert(it->second);
2823 }
2824 }
2825 const bool origNames = OptionsCont::getOptions().getBool("output.original-names");
2826 for (NBNode* node : toChange) {
2827 myNodes.erase(node->getID());
2828 }
2829 for (NBNode* node : toChange) {
2830 if (origNames && node->getParameter(SUMO_PARAM_ORIGID) == "") {
2831 node->setParameter(SUMO_PARAM_ORIGID, node->getID());
2832 }
2833 node->setID(idSupplier.getNext());
2834 for (NBTrafficLightDefinition* tlDef : node->getControllingTLS()) {
2835 tlc.rename(tlDef, node->getID());
2836 }
2837 myNodes[node->getID()] = node;
2838 }
2839 if (prefix.empty()) {
2840 return (int)toChange.size();
2841 } else {
2842 int renamed = 0;
2843 // make a copy because we will modify the map
2844 auto oldNodes = myNodes;
2845 for (auto item : oldNodes) {
2846 if (!StringUtils::startsWith(item.first, prefix)) {
2847 rename(item.second, prefix + item.first);
2848 for (NBTrafficLightDefinition* tlDef : item.second->getControllingTLS()) {
2849 if (!StringUtils::startsWith(tlDef->getID(), prefix)) {
2850 tlc.rename(tlDef, prefix + tlDef->getID());
2851 }
2852 }
2853 renamed++;
2854 }
2855 }
2856 return renamed;
2857 }
2858}
2859
2860
2861int
2863 // guess outer fringe by topology and being on the pareto-boundary
2864 NodeSet topRightFront;
2865 NodeSet topLeftFront;
2866 NodeSet bottomRightFront;
2867 NodeSet bottomLeftFront;
2868 for (const auto& item : myNodes) {
2869 paretoCheck(item.second, topRightFront, 1, 1);
2870 paretoCheck(item.second, topLeftFront, -1, 1);
2871 paretoCheck(item.second, bottomRightFront, 1, -1);
2872 paretoCheck(item.second, bottomLeftFront, -1, -1);
2873 }
2874 NodeSet front;
2875 front.insert(topRightFront.begin(), topRightFront.end());
2876 front.insert(topLeftFront.begin(), topLeftFront.end());
2877 front.insert(bottomRightFront.begin(), bottomRightFront.end());
2878 front.insert(bottomLeftFront.begin(), bottomLeftFront.end());
2879 int numFringe = 0;
2880 for (NBNode* n : front) {
2881 const int in = (int)n->getIncomingEdges().size();
2882 const int out = (int)n->getOutgoingEdges().size();
2883 if ((in <= 1 && out <= 1) &&
2884 (in == 0 || out == 0
2885 || n->getIncomingEdges().front()->isTurningDirectionAt(n->getOutgoingEdges().front()))) {
2886 n->setFringeType(FringeType::OUTER);
2887 numFringe++;
2888 }
2889 }
2890 // guess outer fringe by topology and speed
2891 const double speedThreshold = OptionsCont::getOptions().getFloat("fringe.guess.speed-threshold");
2892 for (const auto& item : myNodes) {
2893 NBNode* n = item.second;
2894 if (front.count(n) != 0) {
2895 continue;
2896 }
2897 if (n->getEdges().size() == 1 && n->getEdges().front()->getSpeed() > speedThreshold) {
2899 numFringe++;
2900 }
2901 }
2902 return numFringe;
2903}
2904
2905
2906void
2907NBNodeCont::paretoCheck(NBNode* node, NodeSet& frontier, int xSign, int ySign) {
2908 const double x = node->getPosition().x() * xSign;
2909 const double y = node->getPosition().y() * ySign;
2910 std::vector<NBNode*> dominated;
2911 for (NBNode* fn : frontier) {
2912 const double x2 = fn->getPosition().x() * xSign;
2913 const double y2 = fn->getPosition().y() * ySign;
2914 if (x2 >= x && y2 >= y) {
2915 return;
2916 } else if (x2 <= x && y2 <= y) {
2917 dominated.push_back(fn);
2918 }
2919 }
2920 frontier.insert(node);
2921 for (NBNode* r : dominated) {
2922 frontier.erase(r);
2923 }
2924}
2925
2926
2927void
2929 for (const auto& item : myNodes) {
2930 NBNode* n = item.second;
2931 if (n->isTLControlled() && n->getRightOfWay() == RightOfWay::DEFAULT) {
2932 bool hasNEMA = false;
2934 if (tl->getType() == TrafficLightType::NEMA) {
2935 hasNEMA = true;
2936 break;
2937 }
2938 }
2939 if (hasNEMA) {
2940 // NEMA controller defaults to allway_stop behavior when switched off
2942 }
2943 }
2944 }
2945}
2946
2947
2948bool
2950 bool hadShapes = false;
2951 for (const auto& item : myNodes) {
2952 if (item.second->getShape().size() > 0 && !item.second->hasCustomShape()) {
2953 hadShapes = true;
2954 item.second->resetShape();
2955 }
2956 }
2957 return hadShapes;
2958}
2959/****************************************************************************/
#define DEBUGCOND(PED)
#define WRITE_WARNINGF(...)
Definition MsgHandler.h:288
#define WRITE_MESSAGEF(...)
Definition MsgHandler.h:290
#define WRITE_ERRORF(...)
Definition MsgHandler.h:297
#define WRITE_MESSAGE(msg)
Definition MsgHandler.h:289
#define WRITE_WARNING(msg)
Definition MsgHandler.h:287
#define TL(string)
Definition MsgHandler.h:305
#define TLF(string,...)
Definition MsgHandler.h:307
std::set< NBNode *, ComparatorIdLess > NodeSet
Definition NBCont.h:52
std::set< NBEdge * > EdgeSet
container for unique edges
Definition NBCont.h:50
std::vector< NBEdge * > EdgeVector
container for (sorted) edges
Definition NBCont.h:42
#define MAX_SLIPLANE_LENGTH
bool isForVulnerableModes(SVCPermissions permissions)
Returns whether an edge with the given permissions allows only vulnerable road users.
bool isRailway(SVCPermissions permissions)
Returns whether an edge with the given permissions is a (exclusive) railway edge.
const SVCPermissions SVC_UNSPECIFIED
permissions not specified
bool isWaterway(SVCPermissions permissions)
Returns whether an edge with the given permissions is a waterway edge.
const std::string & getVehicleClassNames(SVCPermissions permissions, bool expand)
Returns the ids of the given classes, divided using a ' '.
long long int SVCPermissions
bitset where each bit declares whether a certain SVC may use this edge/lane
@ SVC_RAIL_CLASSES
classes which drive on tracks
@ SVC_PASSENGER
vehicle is a passenger car (a "normal" car)
@ SVC_DELIVERY
vehicle is a small delivery vehicle
@ SVC_VULNERABLE
@ SVC_TRAM
vehicle is a light rail
@ SVC_PEDESTRIAN
pedestrian
const std::string SUMO_PARAM_ORIGID
SumoXMLNodeType
Numbers representing special SUMO-XML-attribute values for representing node- (junction-) types used ...
int gPrecision
the precision for floating point outputs
Definition StdDefs.cpp:26
bool gDebugFlag1
global utility flags for debugging
Definition StdDefs.cpp:37
const double SUMO_const_laneWidth
Definition StdDefs.h:48
T MIN2(T a, T b)
Definition StdDefs.h:76
T MAX2(T a, T b)
Definition StdDefs.h:82
std::string joinNamedToString(const std::set< T *, C > &ns, const T_BETWEEN &between)
Definition ToString.h:317
std::string joinToString(const std::vector< T > &v, const T_BETWEEN &between, std::streamsize accuracy=gPrecision)
Definition ToString.h:283
std::string toString(const T &t, std::streamsize accuracy=gPrecision)
Definition ToString.h:46
static methods for processing the coordinates conversion for the current net
const Boundary & getOrigBoundary() const
Returns the original boundary.
static GeoConvHelper & getProcessing()
the coordinate transformation to use for input conversion and processing
const Position getOffsetBase() const
Returns the network base.
const Boundary & getConvBoundary() const
Returns the converted boundary.
std::string getNext()
Returns the next id.
A container for districts.
A class representing a single district.
Definition NBDistrict.h:62
Storage for edges, including some functionality operating on multiple edges.
Definition NBEdgeCont.h:59
NBEdge * getByID(const std::string &edgeID) const
Returns the edge with id if it exists.
const std::set< EdgeSet > getRoundabouts() const
Returns the determined roundabouts.
std::map< std::string, NBEdge * >::const_iterator begin() const
Returns the pointer to the begin of the stored edges.
Definition NBEdgeCont.h:171
void extract(NBDistrictCont &dc, NBEdge *edge, bool remember=false)
Removes the given edge from the container like erase but does not delete it.
void erase(NBDistrictCont &dc, NBEdge *edge)
Removes the given edge from the container (deleting it)
NBEdge * retrieve(const std::string &id, bool retrieveExtracted=false) const
Returns the edge that has the given id.
std::map< std::string, NBEdge * >::const_iterator end() const
Returns the pointer to the end of the stored edges.
Definition NBEdgeCont.h:178
bool hasPostProcessConnection(const std::string &from, const std::string &to="")
add post process connections
void removeRoundaboutEdges(const EdgeSet &toRemove)
remove edges from all stored roundabouts
void joinSameNodeConnectingEdges(NBDistrictCont &dc, NBTrafficLightLogicCont &tlc, EdgeVector edges)
Joins the given edges because they connect the same nodes.
std::vector< std::string > getAllNames() const
Returns all ids of known edges.
The representation of a single edge during network building.
Definition NBEdge.h:92
double getLength() const
Returns the computed length of the edge.
Definition NBEdge.h:593
SVCPermissions getPermissions(int lane=-1) const
get the union of allowed classes over all lanes or for a specific lane
Definition NBEdge.cpp:4469
const std::vector< Connection > & getConnections() const
Returns the connections.
Definition NBEdge.h:1041
const Position & getSignalPosition() const
Returns the position of a traffic signal on this edge.
Definition NBEdge.h:712
double getLoadedLength() const
Returns the length was set explicitly or the computed length if it wasn't set.
Definition NBEdge.h:602
NBNode * getToNode() const
Returns the destination node of the edge.
Definition NBEdge.h:546
static EdgeVector filterByPermissions(const EdgeVector &edges, SVCPermissions permissions)
return only those edges that permit at least one of the give permissions
Definition NBEdge.cpp:4941
EdgeBuildingStep getStep() const
The building step of this edge.
Definition NBEdge.h:635
NBEdge * getStraightContinuation(SVCPermissions permissions) const
return the straightest follower edge for the given permissions or nullptr (never returns turn-arounds...
Definition NBEdge.cpp:4952
bool isNearEnough2BeJoined2(NBEdge *e, double threshold) const
Check if edge is near enought to be joined to another edge.
Definition NBEdge.cpp:4113
@ INIT
The edge has been loaded, nothing is computed yet.
double getSpeed() const
Returns the speed allowed on this edge.
Definition NBEdge.h:619
const std::string & getID() const
Definition NBEdge.h:1531
static const double UNSPECIFIED_SIGNAL_OFFSET
unspecified signal offset
Definition NBEdge.h:367
const NBNode * getSignalNode() const
Returns the node that (possibly) represents a traffic signal controlling at the end of this edge.
Definition NBEdge.h:717
int getNumLanesThatAllow(SVCPermissions permissions, bool allPermissions=true) const
Definition NBEdge.cpp:4598
@ USER
The connection was given by the user.
NBNode * getFromNode() const
Returns the origin node of the edge.
Definition NBEdge.h:539
double getAngleAtNode(const NBNode *const node) const
Returns the angle of the edge's geometry at the given node.
Definition NBEdge.cpp:2160
double getSignalOffset() const
Returns the offset of a traffic signal from the end of this edge.
Definition NBEdge.cpp:4516
int getPriority() const
Returns the priority of the edge.
Definition NBEdge.h:527
const PositionVector & getLaneShape(int i) const
Returns the shape of the nth lane.
Definition NBEdge.cpp:986
void append(NBEdge *continuation)
append another edge
Definition NBEdge.cpp:4036
static void loadPrefixedIDsFomFile(const std::string &file, const std::string prefix, std::set< std::string > &into)
Add prefixed ids defined in file.
static double relAngle(double angle1, double angle2)
computes the relative angle between the two angles
Definition NBHelpers.cpp:45
static void loadEdgesFromFile(const std::string &file, std::set< std::string > &into)
Add edge ids defined in file (either ID or edge:ID per line) into the given set.
Definition NBHelpers.cpp:86
void clear()
deletes all nodes
std::set< std::string > myJoinExclusions
set of node ids which should not be joined
Definition NBNodeCont.h:452
std::vector< std::vector< std::string > > myRailComponents
network components that must be removed if not connected to the road network via stop access
Definition NBNodeCont.h:476
static double getDiameter(const NodeSet &cluster)
compute the maximum distance between any two cluster nodes
NamedRTree myRTree
node positions for faster lookup
Definition NBNodeCont.h:473
void avoidOverlap()
fix overlap
int removeRailComponents(NBDistrictCont &dc, NBEdgeCont &ec, NBPTStopCont &sc)
bool onlyCrossings(const NodeSet &c) const
check wheter the set of nodes only contains pedestrian crossings
std::vector< std::pair< std::set< std::string >, NBNode * > > myClusters2Join
loaded sets of node ids to join (cleared after use)
Definition NBNodeCont.h:455
std::string createClusterId(const NodeSet &cluster, const std::string &prefix="cluster_")
generate id from cluster node ids
Definition NBNodeCont.h:136
std::map< std::string, NBNode * >::const_iterator begin() const
Returns the pointer to the begin of the stored nodes.
Definition NBNodeCont.h:113
void recheckGuessedTLS(NBTrafficLightLogicCont &tlc)
recheck myGuessedTLS after node logics are computed
std::vector< NodeSet > NodeClusters
Definition of a node cluster container.
Definition NBNodeCont.h:61
void computeKeepClear()
compute keepClear status for all connections
NodeCont myNodes
The map of names to nodes.
Definition NBNodeCont.h:446
bool reduceToCircle(NodeSet &cluster, int circleSize, NodeSet startNodes, double maxDist, std::vector< NBNode * > cands=std::vector< NBNode * >()) const
try to find a joinable subset (recursively)
void registerJoinedCluster(const NodeSet &cluster)
gets all joined clusters (see doc for myClusters2Join)
std::string getFreeID()
generates a new node ID
int removeSelfLoops(NBDistrictCont &dc, NBEdgeCont &ec, NBTrafficLightLogicCont &tc)
Removes self-loop edges (edges where the source and the destination node are the same)
bool recheckTLSThreshold(NBNode *node)
check whether a specific guessed tls should keep its type
void paretoCheck(NBNode *node, NodeSet &frontier, int xSign, int ySign)
update pareto frontier with the given node
bool maybeSlipLaneStart(const NBNode *n, EdgeVector &outgoing, double &inAngle) const
check whether the given node maybe the start of a slip lane
void addJoinExclusion(const std::vector< std::string > &ids)
bool erase(NBNode *node)
Removes the given node, deleting it.
int joinLoadedClusters(NBDistrictCont &dc, NBEdgeCont &ec, NBTrafficLightLogicCont &tlc)
Joins loaded junction clusters (see NIXMLNodesHandler)
static bool geometryLikeForClass(const NBNode *n, SVCPermissions permissions)
check whether the node is geometryLike when only considering edges that support the given permissions
void applyConditionalDefaults()
apply default values after loading
void pruneSlipLaneNodes(NodeSet &cluster, double maxDist) const
remove nodes that form a slip lane from cluster
bool insert(const std::string &id, const Position &position, NBDistrict *district=0)
Inserts a node into the map.
std::set< const NBNode * > myUnsetTLS
nodes that are excluded from tls-guessing
Definition NBNodeCont.h:470
int remapIDs(bool numericaIDs, bool reservedIDs, const std::string &prefix, NBTrafficLightLogicCont &tlc)
remap node IDs according to options –numerical-ids and –reserved-ids
NBNode * retrieve(const std::string &id) const
Returns the node with the given name.
NodeCont myExtractedNodes
The extracted nodes which are kept for reference.
Definition NBNodeCont.h:449
void joinTLS(NBTrafficLightLogicCont &tlc, double maxdist)
Builds clusters of tls-controlled junctions and joins the control if possible.
int removeUnwishedNodes(NBDistrictCont &dc, NBEdgeCont &ec, NBTrafficLightLogicCont &tlc, NBPTStopCont &sc, NBPTLineCont &lc, NBParkingCont &pc, bool removeGeometryNodes)
Removes "unwished" nodes.
~NBNodeCont()
Destructor.
bool extract(NBNode *node, bool remember=false)
Removes the given node but does not delete it.
void pruneClusterFringe(NodeSet &cluster, double maxDist, bool remove2TLS=false) const
remove geometry-like fringe nodes from cluster
int removeComponents(NBDistrictCont &dc, NBEdgeCont &ec, const int numKeep, bool hasPTStops)
Checks the network for weak connectivity and removes all but the largest components....
std::vector< std::string > getAllNames() const
get all node names
void computeLogics2(const NBEdgeCont &ec, OptionsCont &oc)
compute right-of-way logic for all lane-to-lane connections
bool shouldBeTLSControlled(const NodeSet &c, double laneSpeedThreshold, bool recheck=false) const
Returns whethe the given node cluster should be controlled by a tls.
void rename(NBNode *node, const std::string &newID)
Renames the node. Throws exception if newID already exists.
void joinSimilarEdges(NBDistrictCont &dc, NBEdgeCont &ec, NBTrafficLightLogicCont &tlc, bool removeDuplicates)
Joins edges connecting the same nodes.
int removeIsolatedRoads(NBDistrictCont &dc, NBEdgeCont &ec)
Removes sequences of edges that are not connected with a junction. Simple roads without junctions som...
void joinNodeClusters(NodeClusters clusters, NBDistrictCont &dc, NBEdgeCont &ec, NBTrafficLightLogicCont &tlc, bool resetConnections=false)
joins the given node clusters
void discardRailSignals()
discards rail signals
void addPrefix(const std::string &prefix)
add prefix to all nodes
void printBuiltNodesStatistics() const
Prints statistics about built nodes.
void setAsTLControlled(NBNode *node, NBTrafficLightLogicCont &tlc, TrafficLightType type, std::string id="")
Sets the given node as being controlled by a tls.
std::set< const NBNode * > mySplit
nodes that were created when splitting an edge
Definition NBNodeCont.h:464
static NodeSet getClusterNeighbors(const NBNode *n, double longThreshold, NodeSet &cluster)
return all cluster neighbors for the given node
void computeLogics(const NBEdgeCont &ec)
build the list of outgoing edges and lanes
void joinNodeCluster(NodeSet clusters, NBDistrictCont &dc, NBEdgeCont &ec, NBTrafficLightLogicCont &tlc, NBNode *predefined=nullptr, bool resetConnections=false)
void unregisterJoinedCluster(const std::set< std::string > &cluster)
remove cluster from list (on netedit-undo)
void generateNodeClusters(double maxDist, NodeClusters &into) const
Builds node clusters.
static bool isSlipLaneContinuation(const NBNode *cont)
whether the given node may continue a slip lane
void computeNodeShapes(double mismatchThreshold=-1)
Compute the junction shape for this node.
std::vector< std::set< std::string > > myJoinedClusters
sets of node ids which were joined
Definition NBNodeCont.h:458
NBEdge * shortestEdge(const NodeSet &cluster, const NodeSet &startNodes, const std::vector< NBNode * > &exclude) const
find closest neighbor for building circle
std::pair< NBNode *, double > NodeAndDist
Definition NBNodeCont.h:62
void guessTLs(OptionsCont &oc, NBTrafficLightLogicCont &tlc)
Guesses which junctions or junction clusters shall be controlled by tls.
bool feasibleCluster(const NodeSet &cluster, const std::map< const NBNode *, std::vector< NBNode * > > &ptStopEnds, double maxDist, std::string &reason, NBNode *&tryRemove) const
determine wether the cluster is not too complex for joining
int guessFringe()
guess and mark fringe nodes
int joinJunctions(double maxDist, NBDistrictCont &dc, NBEdgeCont &ec, NBTrafficLightLogicCont &tlc, NBPTStopCont &sc)
Joins junctions that are very close together.
void computeLanes2Lanes()
divides the incoming lanes on outgoing lanes
void discardTrafficLights(NBTrafficLightLogicCont &tlc, bool geometryLike)
std::set< NBNode *, ComparatorIdLess > myGuessedTLS
nodes that received a traffic light due to guessing (–tls.guess)
Definition NBNodeCont.h:467
std::set< std::string > myJoined
ids found in loaded join clusters used for error checking
Definition NBNodeCont.h:461
int joinSameJunctions(NBDistrictCont &dc, NBEdgeCont &ec, NBTrafficLightLogicCont &tlc)
Joins junctions with the same coordinates regardless of topology.
void analyzeCluster(NodeSet cluster, std::string &id, Position &pos, bool &hasTLS, TrafficLightType &type, SumoXMLNodeType &nodeType)
void addCluster2Join(const std::set< std::string > &cluster, NBNode *node)
add ids of nodes which shall be joined into a single node
bool customTLID(const NodeSet &c) const
check wheter the set of nodes contains traffic lights with custom id
bool resetNodeShapes()
reset all node shapes
static int pruneLongEdges(NodeSet &cluster, double maxDist, const bool dryRun=false)
avoid removal of long edges when joining junction clusters
bool maybeSlipLaneEnd(const NBNode *n, EdgeVector &incoming, double &outAngle) const
check whether the given node maybe the end of a slip lane
Represents a single node (junction) during network building.
Definition NBNode.h:66
bool hasIncoming(const NBEdge *const e) const
Returns whether the given edge ends at this node.
Definition NBNode.cpp:1969
RightOfWay getRightOfWay() const
Returns hint on how to compute right of way.
Definition NBNode.h:300
const std::set< NBTrafficLightDefinition * > & getControllingTLS() const
Returns the traffic lights that were assigned to this node (The set of tls that control this node)
Definition NBNode.h:340
void reinit(const Position &position, SumoXMLNodeType type, bool updateEdgeGeometries=false)
Resets initial values.
Definition NBNode.cpp:346
SumoXMLNodeType getType() const
Returns the type of this node.
Definition NBNode.h:285
void setRightOfWay(RightOfWay rightOfWay)
set method for computing right-of-way
Definition NBNode.h:573
static bool isTrafficLight(SumoXMLNodeType type)
return whether the given type is a traffic light
Definition NBNode.cpp:4251
const EdgeVector & getIncomingEdges() const
Returns this node's incoming edges (The edges which yield in this node)
Definition NBNode.h:268
std::vector< std::pair< NBEdge *, NBEdge * > > getEdgesToJoin() const
get edges to join
Definition NBNode.cpp:2722
const EdgeVector & getOutgoingEdges() const
Returns this node's outgoing edges (The edges which start at this node)
Definition NBNode.h:273
void removeTrafficLights(bool setAsPriority=false)
Removes all references to traffic lights that control this tls.
Definition NBNode.cpp:421
int removeSelfLoops(NBDistrictCont &dc, NBEdgeCont &ec, NBTrafficLightLogicCont &tc)
Removes edges which are both incoming and outgoing into this node.
Definition NBNode.cpp:475
std::vector< Crossing * > getCrossings() const
return this junctions pedestrian crossings
Definition NBNode.cpp:3073
void replaceIncoming(NBEdge *which, NBEdge *by, int laneOff)
Replaces occurrences of the first edge within the list of incoming by the second Connections are rema...
Definition NBNode.cpp:1863
EdgeVector getPassengerEdges(bool incoming) const
return edges that permit passengers (either incoming or outgoing)
Definition NBNode.cpp:2462
const Position & getPosition() const
Definition NBNode.h:260
void removeTrafficLight(NBTrafficLightDefinition *tlDef)
Removes the given traffic light from this node.
Definition NBNode.cpp:414
const EdgeVector & getEdges() const
Returns all edges which participate in this node (Edges that start or end at this node)
Definition NBNode.h:278
void updateSurroundingGeometry()
update geometry of node and surrounding edges
Definition NBNode.cpp:1160
bool checkIsRemovable() const
check if node is removable
Definition NBNode.cpp:2639
void setFringeType(FringeType fringeType)
set method for computing right-of-way
Definition NBNode.h:578
bool geometryLike() const
whether this is structurally similar to a geometry node
Definition NBNode.cpp:4012
bool isNearDistrict() const
@chech if node is near district
Definition NBNode.cpp:2787
bool isTLControlled() const
Returns whether this node is controlled by any tls.
Definition NBNode.h:331
static bool isRailwayNode(const NBNode *n)
whether the given node only has rail edges
A traffic light logics which must be computed (only nodes/edges are given)
Definition NBOwnTLDef.h:44
void replaceEdge(const std::string &edgeID, const EdgeVector &replacement)
replace the edge with the given edge list in all lines
Container for public transport stops during the net building process.
void replaceEdge(const std::string &edgeID, const std::vector< NBEdge * > &replacement)
replace the edge with the closes edge on the given edge list in all stops
const std::map< std::string, std::shared_ptr< NBPTStop > > & getStops() const
Returns an unmodifiable reference to the stored pt stops.
void addEdges2Keep(const OptionsCont &oc, std::set< std::string > &into)
add edges that must be kept
void addEdges2Keep(const OptionsCont &oc, std::set< std::string > &into)
add edges that must be kept
Definition NBParking.cpp:78
The base class for traffic light logic definitions.
const std::vector< NBNode * > & getNodes() const
Returns the list of controlled nodes.
A container for traffic light definitions and built programs.
bool exist(const std::string &newID, bool requireComputed=true) const
check if exists a definition with the given ID
void rename(NBTrafficLightDefinition *tlDef, const std::string &newID)
rename traffic light
bool computeSingleLogic(OptionsCont &oc, NBTrafficLightDefinition *def)
Computes a specific traffic light logic (using by netedit)
bool removeFully(const std::string id)
Removes a logic definition (and all programs) from the dictionary.
bool insert(NBTrafficLightDefinition *logic, bool forceInsert=false)
Adds a logic definition to the dictionary.
void extract(NBTrafficLightDefinition *definition)
Extracts a traffic light definition from myDefinitions but keeps it in myExtracted for eventual * del...
Allows to store the object; used as context while traveling the rtree in TraCI.
Definition Named.h:90
Base class for objects which have an id.
Definition Named.h:54
virtual void setID(const std::string &newID)
resets the id
Definition Named.h:82
const std::string & getID() const
Returns the id.
Definition Named.h:74
void Remove(const float a_min[2], const float a_max[2], Named *const &a_data)
Remove entry.
Definition NamedRTree.h:90
void Insert(const float a_min[2], const float a_max[2], Named *const &a_data)
Insert entry.
Definition NamedRTree.h:79
int Search(const float a_min[2], const float a_max[2], const Named::StoringVisitor &c) const
Find all within search rectangle.
Definition NamedRTree.h:112
A storage for options typed value containers)
Definition OptionsCont.h:89
bool isSet(const std::string &name, bool failOnNonExistant=true) const
Returns the information whether the named option is set.
double getFloat(const std::string &name) const
Returns the double-value of the named option (only for Option_Float)
int getInt(const std::string &name) const
Returns the int-value of the named option (only for Option_Integer)
std::string getString(const std::string &name) const
Returns the string-value of the named option (only for Option_String)
bool isDefault(const std::string &name) const
Returns the information whether the named option has still the default value.
bool exists(const std::string &name) const
Returns the information whether the named option is known.
bool getBool(const std::string &name) const
Returns the boolean-value of the named option (only for Option_Bool)
const StringVector & getStringVector(const std::string &name) const
Returns the list of string-value of the named option (only for Option_StringVector)
static OptionsCont & getOptions()
Retrieves the options.
static std::string realString(const double v, const int precision=gPrecision)
Helper method for string formatting.
virtual void setParameter(const std::string &key, const std::string &value)
Sets a parameter.
A point in 2D or 3D with translation and scaling methods.
Definition Position.h:37
void setx(double x)
set position x
Definition Position.h:67
static const Position INVALID
used to indicate that a position is valid
Definition Position.h:319
double distanceTo2D(const Position &p2) const
returns the euclidean distance in the x-y-plane
Definition Position.h:273
double x() const
Returns the x-position.
Definition Position.h:52
void add(const Position &pos)
Adds the given position to this one.
Definition Position.h:129
void setz(double z)
set position z
Definition Position.h:77
void mul(double val)
Multiplies position with the given value.
Definition Position.h:102
double z() const
Returns the z-position.
Definition Position.h:62
void sety(double y)
set position y
Definition Position.h:72
double y() const
Returns the y-position.
Definition Position.h:57
static StringBijection< TrafficLightType > TrafficLightTypes
traffic light types
T get(const std::string &str) const
get key
static long long int toLong(const std::string &sData)
converts a string into the long value described by it by calling the char-type converter,...
static bool startsWith(const std::string &str, const std::string prefix)
Checks whether a given string starts with the prefix.
static double fn[10]
Definition odrSpiral.cpp:87