-
Notifications
You must be signed in to change notification settings - Fork 662
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
feat(planning_validator): add validation for trajectory length and re…
…lated tests (#6195) * tmp modify for smoother Signed-off-by: Takamasa Horibe <[email protected]> * improve planning validator Signed-off-by: Takamasa Horibe <[email protected]> * Revert "tmp modify for smoother" This reverts commit a360bd0. * remove undesired debug dependency Signed-off-by: Takamasa Horibe <[email protected]> * fix include guard Signed-off-by: Takamasa Horibe <[email protected]> * remove unintentional change Signed-off-by: Takamasa Horibe <[email protected]> * use acceleration to calculate required trajectory length Signed-off-by: Takamasa Horibe <[email protected]> * fix tests Signed-off-by: Takamasa Horibe <[email protected]> * remove debug comment Signed-off-by: Takamasa Horibe <[email protected]> --------- Signed-off-by: Takamasa Horibe <[email protected]>
- Loading branch information
1 parent
7d8ee41
commit b09bf92
Showing
11 changed files
with
756 additions
and
75 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Original file line number | Diff line number | Diff line change |
---|---|---|
@@ -0,0 +1,38 @@ | ||
|
||
// Copyright 2024 TIER IV, Inc. | ||
// | ||
// Licensed under the Apache License, Version 2.0 (the "License"); | ||
// you may not use this file except in compliance with the License. | ||
// You may obtain a copy of the License at | ||
// | ||
// http://www.apache.org/licenses/LICENSE-2.0 | ||
// | ||
// Unless required by applicable law or agreed to in writing, software | ||
// distributed under the License is distributed on an "AS IS" BASIS, | ||
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. | ||
// See the License for the specific language governing permissions and | ||
// limitations under the License. | ||
|
||
#ifndef TEST_PARAMETER_HPP_ | ||
#define TEST_PARAMETER_HPP_ | ||
|
||
constexpr double deg2rad = 3.14159265 / 180.0; | ||
constexpr double kmph2mps = 1.0 / 3.6; | ||
|
||
constexpr double WHEELBASE = 3.5; | ||
|
||
constexpr double THRESHOLD_INTERVAL = 1.0; | ||
constexpr double THRESHOLD_RELATIVE_ANGLE = 115.0 * deg2rad; | ||
constexpr double THRESHOLD_CURVATURE = 0.3; | ||
constexpr double THRESHOLD_LATERAL_ACC = 5.0; | ||
constexpr double THRESHOLD_LONGITUDINAL_MAX_ACC = 3.0; | ||
constexpr double THRESHOLD_LONGITUDINAL_MIN_ACC = -6.0; | ||
constexpr double THRESHOLD_STEERING = 35.0 * deg2rad; | ||
constexpr double THRESHOLD_STEERING_RATE = 7.0 * deg2rad; | ||
constexpr double THRESHOLD_VELOCITY_DEVIATION = 15.0 * kmph2mps; | ||
constexpr double THRESHOLD_DISTANCE_DEVIATION = 3.0; | ||
constexpr double THRESHOLD_LONGITUDINAL_DISTANCE_DEVIATION = 2.0; | ||
constexpr double PARAMETER_FORWARD_TRAJECTORY_LENGTH_ACCELERATION = -5.0; | ||
constexpr double PARAMETER_FORWARD_TRAJECTORY_LENGTH_MARGIN = 2.0; | ||
|
||
#endif // TEST_PARAMETER_HPP_ |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
Oops, something went wrong.