PIDController.hpp

Go to the documentation of this file.

#ifndef PID_CONTROLLER_HPP
#define PID_CONTROLLER_HPP
 
#include <Eigen/Core>
#include "PIDCtrlParams.hpp"
 
namespace wbc{

class PIDController{
protected:
    PIDCtrlParams pid_params;
    uint dimension;
    Eigen::VectorXd control_error;
    Eigen::VectorXd prev_control_error;
    Eigen::VectorXd dead_zone;
    Eigen::VectorXd max_ctrl_output;
    Eigen::VectorXd integral;
    Eigen::VectorXd derivative;
    Eigen::VectorXd control_output;
    Eigen::VectorXd setpoint;
    Eigen::VectorXd feedback;
 
public:
    PIDController(uint dimension);
    virtual ~PIDController(){}

    void update(const double delta_t);
 
    void setPID(const PIDCtrlParams &params);
    const PIDCtrlParams &getPID(){return pid_params;}
    void setMaxCtrlOutput(const Eigen::VectorXd &max);
    const Eigen::VectorXd &maxCtrlOutput(){return max_ctrl_output;}
    void setDeadZone(const Eigen::VectorXd &dz);
    const Eigen::VectorXd &deadZone(){return dead_zone;}
    void applySaturation(const Eigen::VectorXd& in, const Eigen::VectorXd& max, Eigen::VectorXd &out);
    void applyDeadZone(const Eigen::VectorXd& in, const Eigen::VectorXd& min, Eigen::VectorXd& out);
    uint getDimension(){return dimension;}
    Eigen::VectorXd getControlError(){return control_error;}
 
    virtual const Eigen::VectorXd& computeDerivative(const double delta_t);
};
 
}
 
#endif