Ajout d'une fonction pour mesurer la vitesse du moteur

Moteur DC/ServoStrap/ServoStrapPortManipulationLD293D_1_2/ServoStrapPortManipulationLD293D_1_2.ino

@@ -57,6 +57,10 @@ int lastError = 0;
 int sumError = 0;
 int StartRoutine=0;
 
+float OldTime = 0;
+float Oldencoder0Pos = 0;
+float MySpeed = 0;
+
 //Integral term min/max (random value and not yet tested/verified)
 int iMax = 100;
 int iMin = 0;
@@ -158,6 +162,12 @@ void Fstart(){
 
 }
 
+void Speed(){
+MySpeed = (Oldencoder0Pos - encoder0Pos) / ( OldTime - millis());
+OldTime = millis();
+Oldencoder0Pos = encoder0Pos;
+}
+
 void docalc() {
   
   if (millis() - previousMillis > interval)