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 RT2_P3_students_G4 by
Revision 11:67af6d24c588, committed 2018-04-27
- Comitter:
- altb
- Date:
- Fri Apr 27 06:54:18 2018 +0000
- Parent:
- 10:85840c065e00
- Commit message:
- ..
Changed in this revision
| PI_Cntrl.cpp | Show annotated file Show diff for this revision Revisions of this file |
| PI_Cntrl.h | Show annotated file Show diff for this revision Revisions of this file |
--- a/PI_Cntrl.cpp Fri Apr 27 06:34:29 2018 +0000
+++ b/PI_Cntrl.cpp Fri Apr 27 06:54:18 2018 +0000
@@ -11,51 +11,3 @@
#include "PI_Cntrl.h"
using namespace std;
-
-PI_Cntrl::PI_Cntrl(float Kp, float Tn, float Ts)
-{
- setCoefficients(Kp, Tn, Ts);
- uMax = 10000000000.0;
- uMin = -uMax;
- reset(0.0f);
-}
-
-PI_Cntrl::PI_Cntrl(float Kp, float Tn, float Ts, float uMax)
-{
- setCoefficients(Kp, Tn, Ts);
- this->uMax = (double)uMax;
- uMin = -(double)uMax;
- reset(0.0f);
-}
-
-PI_Cntrl::PI_Cntrl(float Kp, float Tn, float Ts, float uMax, float uMin)
-{
- setCoefficients(Kp, Tn, Ts);
- this->uMax = (double)uMax;
- this->uMin = (double)uMin;
- reset(0.0f);
-}
-
-PI_Cntrl::~PI_Cntrl() {}
-
-void PI_Cntrl::reset(float initValue)
-{
- s = (double)initValue;
-}
-
-void PI_Cntrl::setCoefficients(float Kp, float Tn, float Ts)
-{
- b0 = (double)Kp*(1.0 + (double)Ts/(double)Tn);
- b1 = -(double)Kp;
- b2 = (double)Ts/(double)Tn;
-}
-
-float PI_Cntrl::doStep(double e)
-{
- double u = b0*e + s; // unconstrained output
- double uc = u; // constrained output
- if(u > uMax) uc = uMax;
- else if(u < uMin) uc = uMin;
- s = b1*e + u - b2*(u - uc);
- return (float)uc;
-}
\ No newline at end of file
--- a/PI_Cntrl.h Fri Apr 27 06:34:29 2018 +0000
+++ b/PI_Cntrl.h Fri Apr 27 06:54:18 2018 +0000
@@ -6,29 +6,9 @@
{
public:
- PI_Cntrl(float Kp, float Tn, float Ts);
- PI_Cntrl(float Kp, float Tn, float Ts, float uMax);
- PI_Cntrl(float Kp, float Tn, float Ts, float uMax, float uMin);
-
- float operator()(float error) {
- return doStep((double)error);
- }
-
- virtual ~PI_Cntrl();
-
- void reset(float initValue);
- float doStep(double error);
private:
- double b0;
- double b1;
- double b2;
- double s;
- double uMax;
- double uMin;
-
- void setCoefficients(float Kp, float Tn, float Ts);
};
