Messa in campo 4 file - 26/06/2020 Francia

Dependencies:   mbed X_NUCLEO_IHM03A1_for

Fork of FORIGO_Modula_V7_3_VdcStep_maggio2020 by Francesco Pistone

Revision:
3:a469bbd294b5
Child:
6:e8c18f0f399a
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/variables.hpp	Wed Feb 13 07:18:01 2019 +0000
@@ -0,0 +1,237 @@
+/*
+    variabili generali di programma e set iniziali
+*/
+
+
+// SET INIZIALI DI MACCHINA
+bool canDataCheckEnable=false;      // a true per attivare il controllo del quinconce anche con dati CAN
+int speedFromPick = 0;              // definisce se il controllo di velocità della ruota di semina è gestita dai becchi (set a 1) o dai fori sul disco (set a 0)
+bool encoder=true;                 // true quando montato motore DC con encoder incorporato
+                                    // NOTA: SE ENCODER=TRUE ALLORA SPEEDFROMPICK DEVE ESSERE MESSO A 0
+int tamburoStandard=1;              // a 1 per tamburo parallelo alla ruota di semina, a 0 per zucca
+int cambiaStep=0;
+uint32_t SDstepEnco=0;
+
+bool tankLevelEnable = false;
+bool seedSensorEnable=false;
+bool stendiNylonEnable=false;
+bool currentCheckEnable=false;
+uint8_t cellsCountSet=1;
+
+// VARIABILI DI PROGRAMMA
+int zeroRequestBuf=0;
+int runRequestBuf=0;
+
+// define cycle variable related to the external command
+int oldTractorSpeedRead=0;
+int startCycle=0;                   // activate motors and functions 
+int enableCycle=0;                  // enable regular cycle
+int zeroCycle=0;                    // azzeramento motori richiesto
+int OldStartCycle=0;                // use for triggering command change
+int OldEnableCycle=0;
+int oldZeroCycle=0;                 // memoria azzeramento motori su richiesta
+int zeroCycleEnd=0;                 // ciclo di azzeramento completato
+int zeroTrigger=0;
+int TBzeroPinInput=0;               // segnale invertito micro tamburo 
+int seedWheelZeroPinInput=0;        // segnale invertito sensore ruota di semina
+int SD_faultA=0;
+int SD_faultB=0;
+int DC_brake=1;                     // comando gestione frenatura motore DC
+int DC_forward=1;                   // comando gestione direzione motore DC
+
+int oldFaseLavoro=0;
+
+// define logic internal variables
+double tractorSpeed_MtS_timed=0.0f;   // tractor speed calculated from pulse interval time
+double speedForDisplay[5]={0.0f,0.0f,0.0f,0.0f,0.0f};
+double totalSpeed=0.0f;
+double OLDpulseSpeedInterval=1000.01f;   // tractor speed calculated from pulse interval time
+double pulseDistance=0.0f;            // linear space between pulse
+double pulseDistanceCalc=0.0f;
+double speedPerimeter=0.0f;           // perimeter of tractor speed wheel 
+double seedPerimeter=0.0f;            // perimeter of seed wheel 
+double mediaSpeed[5]={0.0f,0.0f,0.0f,0.0f,0.0f};
+int pntMedia=0;
+int actualPulseReadTimer=0;             // timer read at previous pulse
+double pulseSpeedInterval=0.0f;            // delta time of pulse
+int lastPulseRead=0;
+int oldLastPulseRead=0;
+int pulseRised=0;                    // pulse from speed wheel occured. Define when is possible to determine speed of up down motor. 
+int pulseRised1 = 0;
+int pulseRised2 = 0;
+
+double rapportoRuote = 0.0f;
+double TBrpm = 0.0f;
+double TBfrequency = 0.0f;
+double TBperiod = 0.0f;
+double oldPeriodoTB = 0.0f;
+int SDzeroCyclePulse=0;
+int TBzeroCyclePulse=0;
+int SDzeroed=0;
+int TBzeroed=0;
+int oldOnSDzero=0;
+int oldOnTBzero=0;
+int oldOffSDzero=0;
+int oldOffTBzero=0;
+int SDzeroPinTrig=0;
+int TBzeroPinTrig=0;
+int SDzeroDebounced=0;
+int SDrunZero=0;
+int TBrunZero=0;
+int syncroCheck=0;
+double memoStepTB=0.0f;
+double erroreSyncro=0.0f;
+double errorePercentuale=1.0f;
+int oldSeedWheelZeroPinInput=0;
+int oldTBzeroPinInput=0;
+int stopCicloTB = 0;
+int startCicloTB = 0;
+int cicloTbinCorso = 0;
+int beccoPronto =0;
+int memoIntraPick=0;
+
+double realGiroSD = 0.0f;
+double tempoBecco = 0.0f;
+double frequenzaReale = 0.0f;
+double semiPeriodoReale = 0.0f;
+double tempoTraBecchi_mS = 0.0f;
+double tempoGiroSD = 0.0f;
+
+// variable for speed and step calculation
+uint32_t prePosSD=0;        // actual position of seed wheel (step of motor)
+uint32_t SDactualPosition=0;        // actual position of seed wheel (step of motor)
+uint32_t TBactualPosition=0;
+uint32_t TBpassPosition=0;
+uint32_t TBoldPosition=0;
+uint32_t posForQuinc=0;
+
+int cycleStopRequest=0;             // when cycle end request the zero of SD and UD
+
+double duty_DC=0.0f;
+double oldDuty_DC=0.0f;
+
+double dcActualDuty = 0.0f;  // valore di lavoro del duty cycle
+double olddcActualDuty = 0.0f;  // valore di lavoro del duty cycle
+double correzione = 0.0f;
+double periodo =0.0f;
+double ePpos = 0.0f;
+int aspettaStart=1;
+int countCicli=0;
+uint32_t fase = 0;
+
+int clocca=0;
+int enableSpeed=0;
+double speedOfSeedWheel =0.0f;
+int lowSpeed = 0;
+double valore=0.0f;
+//char val1[8]={0,0,0,0,0,0,0,0};
+
+uint8_t enableSimula=0;
+uint8_t speedSimula=0;
+uint8_t avviaSimula=0;
+double oldSimulaSpeed=0.0f;
+int selezionato =0;
+int simOk=0;
+
+float SD_CurrentAnalog=0.0f;                    // valore di corrente sull'ingresso
+float SD_CurrentScaled=0.0f;                    // valore di corrente convertito in scala
+float SD_CurrentFactor=40.0f;                   // fattore di scala sensore 40mV/A
+float SD_CurrentPeak=0.0f;                      // valore massimo corrente
+float SD_CurrentMid=0.0f;                       // valore medio corrente
+float SD_CurrentLast=0.0f;                      // valore precedente corrente
+float SD_CurrentStart=0.0f;                     // valore a vuoto corrente (circa il 50% della tensione di alimentazione del sensore)
+bool reduceCurrent=false;
+bool incrementCurrent=false;
+double boostDcOut=0.0f;
+
+float SD_analogMatrix[21]={0.0f,0.0f,0.0f,0.0f,0.0f,0.0f,0.0f,0.0f,0.0f,0.0f,0.0f,0.0f,0.0f,0.0f,0.0f,0.0f,0.0f,0.0f,0.0f,0.0f,0.0f};
+int SD_analogIndex[11]={0,0,0,0,0,0,0,0,0,0};
+int frenata=0;
+int accensione=1;
+double SDsectorStep =0.0f;
+double TBsectorStep = 0.0f;
+double KcorT = 0.0f;
+
+int trigSD=0;
+int trigTB=0;
+int inhibit=0;
+int trigCicli=0;
+int avvicinamento=0;
+int lowSpeedRequired=0;
+
+uint8_t alarmHighRegister=0x00;
+uint8_t alarmLowRegister=0x00;
+double TBgiroStep=0.0f;
+int firstStart=1;
+int noSDzeroRequest=0;
+int timeHole=0;
+int memoTimeHole=0;
+int lockStart=0;
+
+uint8_t quincStart=0;
+uint8_t oldQuincIn=0;
+double scostamento = 0.0f;
+uint8_t quincEnable=0;
+uint8_t quincCnt=0;
+double percento=0.0f;
+uint32_t masterSinc=0;
+uint32_t mast2_Sinc=0;
+bool quincClock=false;
+double oldQuincTimeSD=0.0f;
+uint8_t sincroQui=0;
+uint8_t quincPIDminus=0;
+uint8_t quincPIDplus=0;
+uint8_t quincLIMminus=0;
+uint8_t quincLIMplus=0;
+double memoCorrCorr=0.0f;
+double speedFromMaster=0.0f;
+uint8_t quincSector=0;
+uint8_t canDataCheck=0;
+double tempoBecchiPerQuinc=0.0f;
+int countPicks=0;
+uint8_t quinconceActive=0;
+uint8_t oldQuinconceOut=0;
+
+double stepGrado = 0.0f;
+double TBfaseStep =0.0f;
+double angoloPh=7.0f;
+double angoloAv=0.0f;
+
+uint8_t checkSDrotation=0;
+uint8_t comandiDaCan=0;
+uint8_t azzeraDaCan=0;
+uint8_t loadDaCan=0;
+uint8_t loadDaCanInCorso=0;
+uint8_t cntCellsForLoad=0;
+uint8_t trigRepos=0;
+uint8_t forzaFase=0;
+uint8_t erroreTamburo=0;
+uint8_t cntCellsForReload=0;
+uint8_t cntTbError=0;
+
+uint8_t cellsCounterLow=0;
+uint8_t cellsCounterHig=0;
+uint8_t pickCounterLow=0;
+uint8_t pickCounterHig=0;
+uint8_t seedSee=0;
+
+uint8_t cntCellsCorrect=0;
+
+uint8_t all_semiFiniti = 0;     // semi finiti (generato dal relativo sensore)
+uint8_t all_pickSignal = 0;     // errore segnale becchi (generato dal tempo tra un becco ed il successivo)
+uint8_t all_cellSignal = 0;     // errore segnale celle (generato dal sensore tamburo )
+uint8_t all_lowBattery = 0;     // allarme batteria (valore interno di tritecnica)
+uint8_t all_overCurrDC = 0;     // sovracorrente motore DC  (generato dal sensore di corrente)
+uint8_t all_stopSistem = 0;     // sistema in stop (a tempo con ruota ferma)
+uint8_t all_upElements = 0;     // elementi sollevati   (generato dal relativo sensore)
+uint8_t all_noSeedOnCe = 0;     // fallanza di semina (manca il seme nella cella)
+uint8_t all_cfgnErrors = 0;     // errore di configurazione     (incongruenza dei parametri impostati)
+uint8_t all_noDcRotati = 0;     // ruota di semina bloccata (arriva la velocità ma non i becchi)
+uint8_t all_noStepRota = 0;     // tamburo di semina bloccato   (comando il tamburo ma non ricevo il sensore)
+uint8_t all_speedError = 0;     // errore sensore velocità  (tempo impulsi non costante)
+uint8_t all_noSpeedSen = 0;     // mancanza segnale di velocità (sento i becchi ma non la velocita)
+uint8_t all_no_Zeroing = 0;     // mancato azzeramento sistema (generato dal timeout del comando motore DC)
+uint8_t all_genericals = 0;     // allarme generico
+uint8_t resetComandi=0;
+
+//uint32_t spazioCoperto=0;
\ No newline at end of file