예제 #1
0
 void initializePathPlanner(){
     //initializeSegments(filename);
     planner = PathPlanner(segments);
     planner.populateTrajectory();
     StateTrajectory* traj = planner.getPathTrajectory();
     for (int i = 0; i < traj->size(); i++){
         cout << traj->at(i).toString() << endl;
     }
 }
예제 #2
0
void getInputSegments(){
    segments.push_back(Line(20, 55, 60, 55)); 
    segments.push_back(Line(20, 5, 20, 55)); //TODO: real input
    segments.push_back(Line(60, 5, 20, 5)); 
    segments.push_back(Line(60, 55, 60, 5));
    //segments.push_back(Line(20, 5, 40, 63));
    
    planner = PathPlanner(segments);
    planner.populateTrajectory();
    StateTrajectory* traj = planner.getPathTrajectory();
    for (int i = 0; i < traj->size(); i++){
        cout << traj->at(i).toString() << endl;
    }
}