- int path = route->get_turnout(link->get_turnout_id());
- if(path>=0)
- trfc_mgr.get_control().get_turnout(link->get_turnout_id()).set_path(path);
+ const Block::Endpoint &ep = link->get_endpoints()[entry];
+ const Endpoint &track_ep = ep.track->get_type().get_endpoints()[ep.track_ep];
+
+ // Keep the blocks reserved so far, as either us or the other train can diverge
+ good = last;
+ good_sens = nsens;
+
+ Turnout &turnout = trfc_mgr.get_control().get_turnout(link->get_turnout_id());
+
+ // Figure out what path we'd like to take on the turnout
+ int path = -1;
+ if(route)
+ path = route->get_turnout(link->get_turnout_id());
+ if(path<0)
+ path = turnout.get_path();
+ if(!((track_ep.paths>>path)&1))
+ {
+ for(unsigned i=0; track_ep.paths>>i; ++i)
+ if((track_ep.paths>>i)&1)
+ path = i;
+ }
+
+ if(path!=turnout.get_path())
+ {
+ // The turnout is set to wrong path - switch and wait for it
+ link->reserve(0);
+ pending_block = link;
+ turnout.set_path(path);
+ break;
+ }