Control code for the peristaltic pump. Includes current control.

Dependencies:   mbed QEI FastAnalogIn mbed-rtos FastPWM

Revision:
6:4e710cef655e
Parent:
4:3bab17dfae4e
--- a/main.cpp	Wed Jan 30 13:05:42 2019 +0000
+++ b/main.cpp	Mon Apr 01 14:15:31 2019 +0000
@@ -481,7 +481,7 @@
     
     //printf("%f\r\n",dblPosD[intDemPosFilOrder]);
     
-    intFeedBack_pos = (int) dblPos[intPosFilOrder]/MAX_ACTUATOR_LENGTH*511;
+    intFeedBack_pos = (int) ((dblPos[intPosFilOrder]/MAX_ACTUATOR_LENGTH)*511);
     
     if(intFeedBack_pos>511)
     {