Formula Student Autonomous Systems
The code for the main driverless system
Loading...
Searching...
No Matches
velocity_planning_tests.cpp
Go to the documentation of this file.
2
7TEST(VelocityPlanning, velocity0) {
8 std::string file_path = "src/planning/tracks/velocity1.txt";
9 VelocityPlanning velocity_planning;
10 std::vector<common_lib::structures::PathPoint> final_path = ::path_from_file(file_path);
11 velocity_planning.set_velocity(final_path);
12
13 EXPECT_EQ((int)final_path.size(), 14);
14 EXPECT_EQ(final_path.back().ideal_velocity, 3);
15}
16
22 std::string file_path = "src/planning/tracks/velocity1.txt";
23 VelocityPlanning velocity_planning;
24 std::vector<common_lib::structures::PathPoint> final_path = ::path_from_file(file_path);
25 velocity_planning.set_velocity(final_path);
26
27 for (const auto& point : final_path) {
28 EXPECT_TRUE(point.ideal_velocity >= 3);
29 }
30
31}
32
38 std::string file_path = "src/planning/tracks/velocity2.txt";
39 VelocityPlanning velocity_planning;
40 std::vector<common_lib::structures::PathPoint> final_path = ::path_from_file(file_path);
41 velocity_planning.set_velocity(final_path);
42
43 EXPECT_EQ((int)final_path.size(), 1);
44 EXPECT_EQ(final_path[0].ideal_velocity, 3);
45}
46
47
53 std::string file_path = "src/planning/tracks/velocity3.txt";
54 VelocityPlanning velocity_planning;
55 std::vector<common_lib::structures::PathPoint> final_path = ::path_from_file(file_path);
56 velocity_planning.set_velocity(final_path);
57
58 EXPECT_EQ((int)final_path.size(), 0);
59}
Computes velocity profiles for a planned path based on curvature and dynamics constraints.
void set_velocity(std::vector< PathPoint > &final_path)
Assigns an velocity to each point of the path.
std::vector< common_lib::structures::PathPoint > path_from_file(const std::string &path)
Retrieves a path point vector from a file.
Definition utils.cpp:76
TEST(VelocityPlanning, velocity0)
simple scenario with few points in the path