33 std::vector<double>
getBiLevelX0(
const perception_msgs::msg::EgoData& ego_data)
override;
41 std::vector<double>
getHighLevelX0(
const perception_msgs::msg::EgoData& ego_data)
override;
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.