19#include "modules/planning/scenarios/park_and_go/proto/park_and_go.pb.h"
24class VehicleStateProvider;
31class ReferenceLineInfo;
39 const double adc_heading,
Frame* frame,
40 const double front_obstacle_buffer);
43 const double adc_heading,
44 const ReferenceLineInfo& reference_line_info,
45 const double heading_buffer);
48 const common::VehicleStateProvider* vehicle_state_provider,
Frame* frame,
Planning module main class.
bool CheckADCSurroundObstacles(const common::math::Vec2d adc_position, const double adc_heading, Frame *frame, const double front_obstacle_buffer)
: front obstacle is far enough before PardAndGo cruise stage (adc_position: center of rear wheel)
bool CheckADCReadyToCruise(const common::VehicleStateProvider *vehicle_state_provider, Frame *frame, const apollo::planning::ScenarioParkAndGoConfig &scenario_config)
bool CheckADCHeading(const common::math::Vec2d adc_position, const double adc_heading, const ReferenceLineInfo &reference_line_info, const double heading_diff_to_reference_line)
Park_and_go: heading angle should be close to reference line before PardAndGo cruise stage