Forigo / Mbed 2 deprecated FORIGO_Modula_V7_3_VdcStep_Modula2021

Dependencies:   mbed X_NUCLEO_IHM03A1_for

Revision:
47:8455eedea226
Parent:
45:162116db828a
Child:
48:d46f3c5638ee
--- a/main.cpp	Wed Dec 02 06:53:10 2020 +0000
+++ b/main.cpp	Wed Dec 02 09:07:00 2020 +0000
@@ -1225,6 +1225,35 @@
                     aggiornaParametri();
                 //}
             }
+            
+            if (rxMsg.id==RX_AngoloAv) {
+                //if (tractorSpeed_MtS_timed==0.0f) {
+                    #if defined(M1)
+                        angoloAv = (double) rxMsg.data[0] ;
+                        aggiornaParametri();
+                    #endif
+                    #if defined(M2)
+                        angoloAv = (double) rxMsg.data[1] ;
+                        aggiornaParametri();
+                    #endif
+                    #if defined(M3)
+                        angoloAv = (double) rxMsg.data[2] ;
+                        aggiornaParametri();
+                    #endif
+                    #if defined(M4)
+                        angoloAv = (double) rxMsg.data[3] ;
+                        aggiornaParametri();
+                    #endif
+                    #if defined(M5)
+                        angoloAv = (double) rxMsg.data[4] ;
+                        aggiornaParametri();
+                    #endif
+                    #if defined(M6)
+                        angoloAv = (double) rxMsg.data[5] ;
+                        aggiornaParametri();
+                    #endif
+                //}
+            }
         if (tractorSpeed_MtS_timed <= 0.01f){
             if (rxMsg.id==RX_AngoloPh) {
                 if (tractorSpeed_MtS_timed==0.0f) {
@@ -1254,7 +1283,7 @@
                     #endif
                 }
             }
-            if (rxMsg.id==RX_AngoloAv) {
+            /*if (rxMsg.id==RX_AngoloAv) {
                 if (tractorSpeed_MtS_timed==0.0f) {
                     #if defined(M1)
                         angoloAv = (double) rxMsg.data[0] ;
@@ -1281,7 +1310,7 @@
                         aggiornaParametri();
                     #endif
                 }
-            }
+            }*/
             if (rxMsg.id==RX_Quinconce) {
                 if (tractorSpeed_MtS_timed==0.0f) {
                     quinconceActive = (uint8_t) rxMsg.data[0];