Add driver for my custom Arduino-based control device

[r2c2.git] / source / libr2c2 / trackiter.cpp

diff --git a/source/libr2c2/trackiter.cpp b/source/libr2c2/trackiter.cpp
index c3bb7d4ae5db5e8ab16def585547dfec090cb101..da949e75160351363b0ec2513deb81143a5ec6ea 100644 (file)
--- a/source/libr2c2/trackiter.cpp
+++ b/source/libr2c2/trackiter.cpp
@@ -30,27 +30,31 @@ BlockIter TrackIter::block_iter() const
        Block &block = _track->get_block();
        const vector<Block::Endpoint> &beps = block.get_endpoints();
 
-       if(_track->get_type().is_turnout())
-       {
-               /* A turnouts is the only track in its block.  Go ahead and find the
-               matching endpoint in the block. */
-               for(unsigned i=0; i<beps.size(); ++i)
-                       if(beps[i].track==_track && beps[i].track_ep==_entry)
-                               return BlockIter(&block, i);
-       }
-       else
+       // See if this track matches an endpoint in the block
+       for(unsigned i=0; i<beps.size(); ++i)
+               if(beps[i].track==_track && beps[i].track_ep==_entry)
+                       return BlockIter(&block, i);
+
+       if(!_track->get_type().is_turnout())
        {
-               TrackIter rev = reverse();
+               /* Since there was no endpoint match, the preceding track can't be in a
+               different block. */
+               TrackIter rev = flip();
+               TrackIter last;
                while(rev && &rev.track()->get_block()==&block)
                {
-                       TrackIter fwd = rev.reverse();
-
-                       for(unsigned i=0; i<beps.size(); ++i)
-                               if(beps[i].track==fwd.track() && beps[i].track_ep==fwd.entry())
-                                       return BlockIter(&block, i);
-
+                       last = rev;
                        rev = rev.next();
                }
+
+               // If we ran out of tracks, return an empty iterator
+               if(!rev)
+                       return BlockIter();
+
+               TrackIter fwd = last.reverse();
+               for(unsigned i=0; i<beps.size(); ++i)
+                       if(beps[i].track==fwd.track() && beps[i].track_ep==fwd.entry())
+                               return BlockIter(&block, i);
        }
 
        throw logic_error("internal error (didn't find block entry endpoint)");