提交 3ebf453f 编写于 作者: K kevin-y-wang 提交者: Xiangquan Xiao

Control: refactor the leadlag control enable flag

上级 5fb7bf80
......@@ -247,9 +247,9 @@ Status LatController::Init(const ControlConf *control_conf) {
LoadLatGainScheduler(lat_controller_conf);
LogInitParameters();
bool enable_leadlag = control_conf_->lat_controller_conf()
.enable_reverse_leadlag_compensation();
if (enable_leadlag) {
bool enable_leadlag_ = control_conf_->lat_controller_conf()
.enable_reverse_leadlag_compensation();
if (enable_leadlag_) {
leadlag_controller_.Init(lat_controller_conf.reverse_leadlag_conf(), ts_);
}
......@@ -488,10 +488,8 @@ Status LatController::ComputeControlCommand(
double steer_angle = 0.0;
double steer_angle_feedback_augment = 0.0;
bool enable_leadlag = control_conf_->lat_controller_conf()
.enable_reverse_leadlag_compensation();
// Augment the feedback control on lateral error at the desired speed domain
if (enable_leadlag) {
if (enable_leadlag_) {
if (FLAGS_enable_feedback_augment_on_high_speed ||
std::fabs(vehicle_state->linear_velocity()) <= low_speed_bound_) {
steer_angle_feedback_augment =
......
......@@ -215,6 +215,7 @@ class LatController : public Controller {
common::MeanFilter heading_error_filter_;
// Lead/Lag controller
bool enable_leadlag_ = false;
LeadlagController leadlag_controller_;
// Mrac controller
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册