N K / Mbed 2 deprecated analoghalls6

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

Fork of analoghalls5 by Bayley Wang

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers pidcontroller.cpp Source File

pidcontroller.cpp

00001 #include "includes.h"
00002 #include "meta.h"
00003 
00004 PidController::PidController(float ki, float kp, float kd, float out_max, float out_min) {
00005     _ki = ki;
00006     _kp = kp;
00007     _kd = kd;
00008     _last_in = 0.0f;
00009     _integral = 0.0f;
00010     _out_max = out_max;
00011     _out_min = out_min;
00012 }
00013 
00014 float PidController::Update(float ref, float in) {
00015     float error = ref - in;
00016     _integral += error;
00017     if (_integral > _out_max) _integral = _out_max;
00018     if (_integral < _out_min) _integral = _out_min;
00019     float deriv = _last_in - in;
00020     _last_in = in;
00021     float tmp = _ki * _integral + _kp * error + _kd * deriv;
00022     if (tmp > _out_max) tmp = _out_max;
00023     if (tmp < _out_min) tmp = _out_min;
00024     return tmp;
00025 }
Generated on Fri Jul 15 2022 12:15:05 by  doxygen 1.7.2