pid_controller.hpp

Go to the documentation of this file.

/*------------------------------------------------------------------------------
* Copyright (C) 2024 LEIDOS.
*
* 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.
 
------------------------------------------------------------------------------*/
 
#include <rclcpp/rclcpp.hpp>
#include "platooning_control/platooning_control_config.hpp"
 
namespace platooning_control
{
   class PIDController
   {
    public:
 
        PIDController();
 
        std::shared_ptr<PlatooningControlPluginConfig> config_ = std::make_shared<PlatooningControlPluginConfig>();
 
 
        // ~PIDController();
 
        // Kp -  proportional gain
        // Ki -  Integral gain
        // Kd -  derivative gain
        // dt -  loop interval time
        // max - maximum value of manipulated variable
        // min - minimum value of manipulated variable
        // PID( double dt, double max, double min, double Kp, double Kd, double Ki );
 
        double calculate( double setpoint, double pv );
        // ~PID();
 
        void reset();
 
    private:
 
        double _pre_error = 0.0;
        double _integral = 0.0;
   };
}