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.
Dependents: Omni_2017_z BETA_A ALPHA_A GAMMA_A ... more
Diff: MD_PID.cpp
- Revision:
- 8:16a31803a60d
- Parent:
- 4:374ca057d8d5
- Child:
- 9:63e5f9d30ec0
--- a/MD_PID.cpp Sat Aug 05 02:34:14 2017 +0000
+++ b/MD_PID.cpp Wed Aug 30 05:23:00 2017 +0000
@@ -5,20 +5,20 @@
MD_PID::MD_PID()
{
- ref1 = 0;
+ ref1 = 0;
}
MD_PID::MD_PID(MD *md_, double kp_, double ki_, double kd_, int pulse_, QEI *qei_)
{
md = md_;
qei = qei_;
-
+
ref1 = 0;
kp = kp_;
ki = ki_;
kd = kd_;
pulse = pulse_;
-
+
Reset();
}
@@ -45,16 +45,16 @@
}
else
duty = ref;
-
+
if(duty > 1.0)
duty = 1.0;
else if(duty < -1.0)
duty = -1.0;
}
-
+
if( ( (ref >= 0) ^ (Speed() >= 0) ) && fabs(Speed()) > stop)
duty = 0;
-
+
md->rotate(duty);
return duty;
}
@@ -108,7 +108,7 @@
md->rotate(-1);
for(int i = 0; i < 200; i++){
PID(0);
- time[i] = ST.read();
+ time[i] = ST.read();
speed[i] = Speed();
wait(interval);
}
@@ -118,8 +118,8 @@
}
}
-MD_PID* Create_MD_PID( PinName channelA, PinName channelB, PinName index, int pulsesPerRev,QEI::Encoding encoding,
- double kp_, double ki_, double kd_, int pulse_,
+MD_PID* Create_MD_PID( PinName channelA, PinName channelB, PinName index, int pulsesPerRev,QEI::Encoding encoding,
+ double kp_, double ki_, double kd_, int pulse_,
PinName pwm, PinName dere)
{
QEI *qei = new QEI (channelA, channelB, index, pulsesPerRev, encoding);