apollo leadlag_controller模块代码分析

leadlag_controller.h

创建基类LeadlagController, 是使用默认积分保持的速度和转向的超前/滞后控制器,怎么理解?
成员函数:
public:
void Init(const LeadlagConf &leadlag_conf, const double dt); //leadlag_conf:超前滞后控制器配置,dt:采样时间间隔
void SetLeadlag(const LeadlagConf &leadlag_conf);
void TransformC2d(const double dt); //使用双线性变换(梯形积分)方法将超前/滞后控制器系数转换为离散时间形式?
void Reset(); //重置超前/滞后控制器变量
virtual double Control(const double error, const double dt); //根据误差计算控制值,error:期望值和测量值之间的差异。
int InnerstateSaturationStatus() const;
protected:
// 连续时域中的控制系数
double alpha_;
double beta_;
double tau_;
double Ts_; //默认情况下,控制采样时间为0.01s。
//离散时域中的控制系数
double kn1_;
double kn0_;
double kd1_;
double kd0_;
//直接形式2的离散时域中的内部(中间)状态
double previous_output_;
double previous_innerstate_;
double innerstate_;
double innerstate_saturation_high_;
double innerstate_saturation_low_;
int innerstate_saturation_status_;
bool transformc2d_enabled_;

其中核心用到了双线性变换法
,但是我也暂时搞不明白,有什么用。

/******************************************************************************
 * Copyright 2019 The Apollo Authors. All Rights Reserved.
 *
 * 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.
 *****************************************************************************/

/**
 * @file lead/lag controller.h
 * @brief Defines the LeadlagController class.
 */

#pragma once

#include "modules/control/proto/leadlag_conf.pb.h"

/**
 * @namespace apollo::control
 * @brief apollo::control
 */
namespace apollo {
namespace control {

/**
* @class LeadlagController
* @brief A lead/lag controller for speed and steering
using defualt integral hold
*/
class LeadlagController {
 public:
  /**
   * @brief initialize lead/lag controller
   * @param leadlag_conf configuration for leadlag controller
   * @param dt sampling time interval
   */
  void Init(const LeadlagConf &leadlag_conf, const double dt);

  /**
   * alpha, beta and tau
   * @param leadlag_conf configuration for leadlag controller
   */
  void SetLeadlag(const LeadlagConf &leadlag_conf);

  /**
   * @brief transfer lead/lag controller coefficients to the discrete-time form,
   with the bilinear transform (trapezoidal integration) method
   * @param dt sampling time interval
   */
  void TransformC2d(const double dt);

  /**
   * @brief reset variables for lead/leg controller
   */
  void Reset();

  /**
   * @brief compute control value based on the error
   * @param error error value, the difference between
   * a desired value and a measured value
   * @param dt sampling time interval
   * @return control value based on Lead/Lag terms
   */
  virtual double Control(const double error, const double dt);

  /**
   * @brief get saturation status
   * @return saturation status
   */
  int InnerstateSaturationStatus() const;

 protected:
  // Control coefficients in contiouous-time domain
  double alpha_ = 0.0;
  double beta_ = 0.0;
  double tau_ = 0.0;
  double Ts_ = 0.01;  // By default, control sampling time is 0.01 sec
  // Control coefficients in discrete-time domain
  double kn1_ = 0.0;
  double kn0_ = 0.0;
  double kd1_ = 0.0;
  double kd0_ = 0.0;
  // Inner (intermedia) state in discrete-time domain at Direct Form II
  double previous_output_ = 0.0;
  double previous_innerstate_ = 0.0;
  double innerstate_ = 0.0;
  double innerstate_saturation_high_ = 0.0;
  double innerstate_saturation_low_ = 0.0;
  int innerstate_saturation_status_ = 0;
  bool transfromc2d_enabled_ = false;
};

}  // namespace control
}  // namespace apollo

  • 0
    点赞
  • 1
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值