new

Dependencies:   mbed CANMsg

Revision:
11:21e990eb31d0
Parent:
10:d85ed006056e
Child:
12:5bfbccfb3cf4
--- a/main.cpp	Thu Dec 27 13:43:31 2018 +0000
+++ b/main.cpp	Thu Dec 27 15:54:22 2018 +0000
@@ -206,10 +206,11 @@
 //*******************************************************
 void cambiaTB(double perio){
     // update TB frequency
+    double limite=400.0f;
     double TBper=0.0f;
     if (aspettaStart==0){
-        if (perio<250.0f){perio=500.0f;}
-        double scala =1.0f;
+        if (perio<limite){perio=limite;}
+        double scala =0.0f;
         if (lowSpeed==1){
             scala =2.0f;
         }else{
@@ -217,7 +218,7 @@
         }
         TBper=perio/scala;
         if (oldPeriodoTB!=TBper){
-            if (TBper >= 250.0f){
+            if (TBper >= (limite/2.0f)){
                 TBticker.attach_us(&step_TBPulseOut,TBper);  // clock time are milliseconds and attach seed motor stepper controls
             }else{
                 TBticker.detach();
@@ -1722,6 +1723,12 @@
                             lockStart=1;
                             periodo = TBperiod;
                             if (aspettaStart==0){cambiaTB(periodo);}
+                            #if defined(pcSerial)
+                                #if defined(inCorre)
+                                    pc.printf("entrato \n");
+                                    pc.printf("Aspetta %d \n",aspettaStart);
+                                #endif
+                            #endif
                         }
                         // controllo di stop
                         double memoIntraP = (double)memoIntraPick*1.8f;