73 double t1 =
x.getTime()+
timeout + 24.0*60.0*60.0;
80 bool checkpoint_in_view =
true;
81 bool checkpoint_in_clear_distance =
true;
85 if(checkpoint_in_view &&
88 if(!checkpoint_in_view || s_con-s_ego>max_distance)checkpoint_in_clear_distance =
false;
89 if(checkpoint_in_view)
91 if(button_pressed && checkpoint_in_clear_distance)
105 if(con.data_.size()==0)
130 std::ifstream
file(filename);
133 std::cout<<
"failed to open file: "<<filename<<std::endl;
136 while(std::getline(
file,line))
139 double X = 0.0,Y = 0.0,Z = 0.0;
142 if(p3==std::string::npos)p3 = line.length();
144 if(
p0==std::string::npos)
146 std::cout<<
"error in file: "<<filename<<std::endl;
151 std::stringstream ss0;
152 ss0<<line.substr(0,
p0);
155 p1 = line.find(
";",
p0+1);
156 if(p1==std::string::npos)p1 = p3;
160 std::stringstream ss0;
161 ss0<<line.substr(
p0+1,p1-1);
167 std::stringstream ss0;
168 ss0<<line.substr(p1+1,p2-1);
A set of virtual traffic lights are switched according to test driver input. CheckpointController is ...
Definition: checkpoint_controller.h:35
adore::params::APCheckpoints * pcheckpoints_
Definition: checkpoint_controller.h:42
std::vector< adore::env::ControlledConnection > checkpoints_
Definition: checkpoint_controller.h:41
adore::mad::AReader< adore::fun::VehicleExtendedState > * xx_reader_
Definition: checkpoint_controller.h:38
adore::env::ThreeLaneViewDecoupled lv_
Definition: checkpoint_controller.h:40
bool loadFromFile(std::string filename)
read a set of 2d/3d coordinates from a csv file and add these to checkpoints_
Definition: checkpoint_controller.h:127
adore::mad::AReader< adore::fun::VehicleMotionState9d > * x_reader_
Definition: checkpoint_controller.h:37
void run()
Definition: checkpoint_controller.h:59
CheckpointController()
Definition: checkpoint_controller.h:44
adore::env::AFactory::TControlledConnectionWriter * cc_writer_
Definition: checkpoint_controller.h:39
~CheckpointController()
Definition: checkpoint_controller.h:51
virtual TControlledConnectionWriter * getCheckPointWriter()=0
virtual TVehicleMotionStateReader * getVehicleMotionStateReader()=0
Definition: controlledconnection.h:81
static adore::env::AFactory * get()
Definition: afactory.h:236
Definition: threelaneviewdecoupled.h:32
virtual adore::view::ALane * getCurrentLane()
Definition: threelaneviewdecoupled.h:405
void update()
Definition: threelaneviewdecoupled.h:373
static adore::fun::AFactory * get()
Definition: afactory.h:170
Definition: vehicleextendedstate.h:26
bool getCheckpointClearance() const
Definition: vehicleextendedstate.h:103
virtual void getData(T &value)=0
virtual bool hasData() const =0
Definition: com_patterns.h:97
virtual void write(const T &value)=0
virtual APCheckpoints * getCheckpoints() const =0
abstract class containing parameters for checkpoint handling
Definition: ap_checkpoints.h:25
virtual double getClearDistance() const =0
returns distance value for resetting current checkpoint
virtual double getClearTimeout() const =0
returns timeout for resetting current checkpoint
static adore::params::AFactory * get()
Definition: afactory.h:103
virtual void toRelativeCoordinates(double xe, double ye, double &s, double &n)=0
virtual double getSMin() const =0
virtual double getOffsetOfRightBorder(double s)=0
virtual double getSMax() const =0
virtual bool isValid() const =0
virtual double getOffsetOfLeftBorder(double s)=0
@ STOP___AND___REMAIN
Definition: controlledconnection.h:40
@ PERMISSIVE___MOVEMENT___ALLOWED
Definition: controlledconnection.h:42
int timeout
Definition: adore_ci_terminator_node.py:25
x
Definition: adore_set_goal.py:30
p0
Definition: adore_set_pose.py:32
string file
Definition: adore_suppress_lanechanges.py:181
Definition: areaofeffectconverter.h:20
Definition: controlledconnection.h:55
This struct holds the motion state of the vehicle in 9d.
Definition: vehiclemotionstate9d.h:39