Skip to content

Commit 49773d9

Browse files
authored
fix(autoware_frenet_planner): fix unusedFunction (#8788)
fix: unusedFunction Signed-off-by: bathteayo <105347690+bathteayo@users.noreply.github.com>
1 parent e228eeb commit 49773d9

File tree

2 files changed

+0
-79
lines changed

2 files changed

+0
-79
lines changed

planning/sampling_based_planner/autoware_frenet_planner/include/autoware_frenet_planner/frenet_planner.hpp

-16
Original file line numberDiff line numberDiff line change
@@ -25,16 +25,6 @@
2525

2626
namespace autoware::frenet_planner
2727
{
28-
/// @brief generate trajectories relative to the reference for the given initial state and sampling
29-
/// parameters
30-
std::vector<Trajectory> generateTrajectories(
31-
const autoware::sampler_common::transform::Spline2D & reference_spline,
32-
const FrenetState & initial_state, const SamplingParameters & sampling_parameters);
33-
/// @brief generate trajectories relative to the reference for the given initial state and sampling
34-
/// parameters
35-
std::vector<Trajectory> generateLowVelocityTrajectories(
36-
const autoware::sampler_common::transform::Spline2D & reference_spline,
37-
const FrenetState & initial_state, const SamplingParameters & sampling_parameters);
3828
/// @brief generate paths relative to the reference for the given initial state and sampling
3929
/// parameters
4030
std::vector<Path> generatePaths(
@@ -51,12 +41,6 @@ Path generateCandidate(
5141
Trajectory generateCandidate(
5242
const FrenetState & initial_state, const FrenetState & target_state, const double duration,
5343
const double time_resolution);
54-
/// @brief generate a low velocity candidate trajectory
55-
/// @details the polynomial for lateral motion (d) is calculated over the longitudinal displacement
56-
/// (s) rather than over time: d(s) and s(t).
57-
Trajectory generateLowVelocityCandidate(
58-
const FrenetState & initial_state, const FrenetState & target_state, const double duration,
59-
const double time_resolution);
6044
/// @brief calculate the cartesian frame of the given path
6145
void calculateCartesian(
6246
const autoware::sampler_common::transform::Spline2D & reference, Path & path);

planning/sampling_based_planner/autoware_frenet_planner/src/frenet_planner/frenet_planner.cpp

-63
Original file line numberDiff line numberDiff line change
@@ -33,45 +33,6 @@
3333

3434
namespace autoware::frenet_planner
3535
{
36-
std::vector<Trajectory> generateTrajectories(
37-
const autoware::sampler_common::transform::Spline2D & reference_spline,
38-
const FrenetState & initial_state, const SamplingParameters & sampling_parameters)
39-
{
40-
std::vector<Trajectory> trajectories;
41-
trajectories.reserve(sampling_parameters.parameters.size());
42-
for (const auto & parameter : sampling_parameters.parameters) {
43-
auto trajectory = generateCandidate(
44-
initial_state, parameter.target_state, parameter.target_duration,
45-
sampling_parameters.resolution);
46-
trajectory.sampling_parameter = parameter;
47-
calculateCartesian(reference_spline, trajectory);
48-
std::stringstream ss;
49-
ss << parameter;
50-
trajectory.tag = ss.str();
51-
trajectories.push_back(trajectory);
52-
}
53-
return trajectories;
54-
}
55-
56-
std::vector<Trajectory> generateLowVelocityTrajectories(
57-
const autoware::sampler_common::transform::Spline2D & reference_spline,
58-
const FrenetState & initial_state, const SamplingParameters & sampling_parameters)
59-
{
60-
std::vector<Trajectory> trajectories;
61-
trajectories.reserve(sampling_parameters.parameters.size());
62-
for (const auto & parameter : sampling_parameters.parameters) {
63-
auto trajectory = generateLowVelocityCandidate(
64-
initial_state, parameter.target_state, parameter.target_duration,
65-
sampling_parameters.resolution);
66-
calculateCartesian(reference_spline, trajectory);
67-
std::stringstream ss;
68-
ss << parameter;
69-
trajectory.tag = ss.str();
70-
trajectories.push_back(trajectory);
71-
}
72-
return trajectories;
73-
}
74-
7536
std::vector<Path> generatePaths(
7637
const autoware::sampler_common::transform::Spline2D & reference_spline,
7738
const FrenetState & initial_state, const SamplingParameters & sampling_parameters)
@@ -108,30 +69,6 @@ Trajectory generateCandidate(
10869
return trajectory;
10970
}
11071

111-
Trajectory generateLowVelocityCandidate(
112-
const FrenetState & initial_state, const FrenetState & target_state, const double duration,
113-
const double time_resolution)
114-
{
115-
Trajectory trajectory;
116-
trajectory.longitudinal_polynomial = Polynomial(
117-
initial_state.position.s, initial_state.longitudinal_velocity,
118-
initial_state.longitudinal_acceleration, target_state.position.s,
119-
target_state.longitudinal_velocity, target_state.longitudinal_acceleration, duration);
120-
const auto delta_s = target_state.position.s - initial_state.position.s;
121-
trajectory.lateral_polynomial = Polynomial(
122-
initial_state.position.d, initial_state.lateral_velocity, initial_state.lateral_acceleration,
123-
target_state.position.d, target_state.lateral_velocity, target_state.lateral_acceleration,
124-
delta_s);
125-
for (double t = 0.0; t <= duration; t += time_resolution) {
126-
trajectory.times.push_back(t);
127-
const auto s = trajectory.longitudinal_polynomial->position(t);
128-
const auto ds = s - initial_state.position.s;
129-
const auto d = trajectory.lateral_polynomial->position(ds);
130-
trajectory.frenet_points.emplace_back(s, d);
131-
}
132-
return trajectory;
133-
}
134-
13572
Path generateCandidate(
13673
const FrenetState & initial_state, const FrenetState & target_state, const double s_resolution)
13774
{

0 commit comments

Comments
 (0)