X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=source%2Flibr2c2%2Ftrain.cpp;h=285a15a27fb83794bcffa9406c144b416e1d0079;hb=d41f66805bc9fe0b33e3d46b47f52e67b5782028;hp=aa2ba3f528627beb093dc936446b1f2b3bbd4d81;hpb=c4daf1cc6b53cae34e46d4125a993ceed500de1a;p=r2c2.git

diff --git a/source/libr2c2/train.cpp b/source/libr2c2/train.cpp
index aa2ba3f..285a15a 100644
--- a/source/libr2c2/train.cpp
+++ b/source/libr2c2/train.cpp
@@ -6,6 +6,7 @@
 #include <msp/time/units.h>
 #include <msp/time/utils.h>
 #include "aicontrol.h"
+#include "beamgate.h"
 #include "block.h"
 #include "catalogue.h"
 #include "driver.h"
@@ -193,6 +194,7 @@ void Train::place(const BlockIter &block)
 
 	allocator.start_from(block);
 	accurate_position = false;
+	last_entry_block = BlockIter();
 
 	if(reverse)
 		vehicles.front()->place(block.reverse().track_iter(), 0, Vehicle::FRONT_BUFFER);
@@ -207,6 +209,7 @@ void Train::unplace()
 
 	allocator.clear();
 	accurate_position = false;
+	last_entry_block = BlockIter();
 
 	for(vector<Vehicle *>::iterator i=vehicles.begin(); i!=vehicles.end(); ++i)
 		(*i)->unplace();
@@ -219,7 +222,7 @@ void Train::stop_at(Block *block)
 
 bool Train::is_block_critical(const Block &block) const
 {
-	return get_reserved_distance_until(&block)<controller->get_braking_distance()*1.3;
+	return get_reserved_distance_until(&block)<=controller->get_braking_distance()*1.3;
 }
 
 BlockIter Train::get_first_noncritical_block() const
@@ -309,6 +312,7 @@ void Train::tick(const Time::TimeDelta &dt)
 		driver.set_loco_reverse(address, r);
 
 		allocator.reverse();
+		last_entry_block = BlockIter();
 	}
 
 	if(speed_quantizer)
@@ -422,28 +426,28 @@ void Train::loco_func_event(unsigned addr, unsigned func, bool state)
 
 void Train::sensor_state_changed(Sensor &sensor, Sensor::State state)
 {
-	if(state!=Sensor::MAYBE_ACTIVE)
+	if(!current_speed_step || state!=Sensor::MAYBE_ACTIVE)
 		return;
 
 	Block *block = sensor.get_block();
 	if(!block || block->get_train()!=this)
 		return;
 
+	if(last_entry_block && &*last_entry_block!=block)
+	{
+		for(BlockIter i=last_entry_block.next(); (i && &*i!=block); i=i.next())
+			if(i->get_train()!=this || i->get_sensor_id())
+				return;
+	}
+
 	if(dynamic_cast<TrackCircuit *>(&sensor))
 	{
-		if(last_entry_block)
+		if(last_entry_block && pure_speed && speed_quantizer)
 		{
-			float travel_distance = -1;
-			if(pure_speed && speed_quantizer && current_speed_step>0)
-				travel_distance = 0;
+			float travel_distance = 0;
 
 			for(BlockIter i=last_entry_block; &*i!=block; i=i.next())
-			{
-				if(i->get_sensor_id())
-					return;
-				if(travel_distance>=0)
-					travel_distance += i->get_path_length(i.entry());
-			}
+				travel_distance += i->get_path_length(i.entry());
 
 			if(travel_distance>0)
 			{
@@ -472,6 +476,25 @@ void Train::sensor_state_changed(Sensor &sensor, Sensor::State state)
 				vehicles.front()->place(track, 0, Vehicle::FRONT_AXLE);
 		}
 	}
+	else if(BeamGate *gate = dynamic_cast<BeamGate *>(&sensor))
+	{
+		if(!advancing && vehicles.front()->get_track())
+		{
+			TrackIter track = allocator.iter_for(*block).track_iter();
+			for(; (track && &track->get_block()==block); track=track.next())
+				if(track.track()==gate->get_track())
+				{
+					if(reverse)
+						track = track.reverse();
+					float offset = gate->get_offset_from_endpoint(track.entry());
+					if(reverse)
+						vehicles.back()->place(track, offset, Vehicle::BACK_BUFFER);
+					else
+						vehicles.front()->place(track, offset, Vehicle::FRONT_BUFFER);
+					break;
+				}
+		}
+	}
 }
 
 void Train::halt_event(bool h)
@@ -487,7 +510,7 @@ float Train::get_reserved_distance_until(const Block *until_block) const
 
 	Vehicle &veh = *(reverse ? vehicles.back() : vehicles.front());
 
-	TrackIter track = veh.get_track_iter();
+	TrackIter track = veh.get_track_iter().track_iter();
 	if(!track)  // XXX Probably unnecessary
 		return 0;