trajectory_optimization v1.3.1
Loading...
Searching...
No Matches
trajectory_optimization_ackermann.hpp
Go to the documentation of this file.
1// Copyright Institute for Automotive Engineering (ika), RWTH Aachen University
2// SPDX-License-Identifier: Apache-2.0
3
4#pragma once
5
7
9
11 public:
17 explicit TrajectoryOptimizationAckermannNode(const rclcpp::NodeOptions& options);
18
19 private:
25 void initializeTrajectory(trajectory_planning_msgs::msg::Trajectory& trajectory) override;
26
33 std::vector<double> getBiLevelX0(const perception_msgs::msg::EgoData& ego_data) override;
34
41 std::vector<double> getHighLevelX0(const perception_msgs::msg::EgoData& ego_data) override;
42
48 void convertToTrajectoryMsg(trajectory_planning_msgs::msg::Trajectory& trajectory) override;
49
50 // parameters
51 // model specific bi-level thresholds
52 double bi_level_dDelta_ = 5.0;
53};
54
55} // namespace trajectory_optimization
void convertToTrajectoryMsg(trajectory_planning_msgs::msg::Trajectory &trajectory) override
Maps the optimized state trajectory into a trajectory message for a kinematic bicycle model with Acke...
std::vector< double > getBiLevelX0(const perception_msgs::msg::EgoData &ego_data) override
Computes the initial optimizer state using bi-level stabilizaion.
TrajectoryOptimizationAckermannNode(const rclcpp::NodeOptions &options)
Initializes the optimization node for a kinematic bicycle model with Ackermann steering.
void initializeTrajectory(trajectory_planning_msgs::msg::Trajectory &trajectory) override
Initializes a drivable trajectory message for a kinematic bicycle model with Ackermann steering.
std::vector< double > getHighLevelX0(const perception_msgs::msg::EgoData &ego_data) override
Computes the initial optimizer state using high-level stabilization.
Namespace for trajectory_optimization package.