modulazione PWM

//Variabili di ingresso
// bInit =bit di inizializzazione del modulo
// fPWMIn = Valore di ingresso da 0-100.00
// fCtrtime =Tempo di controllo in sec.
// fPlcTime =Tempo di controllo del PLC in sec


//variabili di uscita
// nTypErr =tipo di errore generato dal modulo vedi tabella in fondo
// bErr =Bit di errore modulo non inizializzato
//bPWMOut =uscita della modulazione PWM


//significato degli errori
// 0 =modulo OK
// 1 =modulo non inizializzato
// 2 = valori non validi i parametri messi valgono 0 opp. negativi
// 3 =il valore fCtrtime è piu piccolo del fPlcTime


var
 bInitDone               : boolean;
 bNewPeriod              : boolean;
 fPwmCycleTime           : real;
 nPwmCycleTicks          : integer;
 nPwmActCycleTick        : integer;
 nPowerOnCycleTicks      : integer;
 nPowerOffCycleTicks     : integer;
 nIng1                   : integer;
 nIng2                   : integer;
 nOut                    : integer;

 const

 nERR_NOERROR            =0;
 nERR_NOINIT             =1;
 nERR_INVALIDPARAM       =2;
 nERR_INVALIDCYCLETIME   =3;
 nERR_CYCLETIMEBIG       =4;

 nDIRECTION_MINUS        =-1;
 nDIRECTION_ZERO         =0;
 nDIRECTION_PLUS         =1;

begin

IF  (bInit) THEN
   begin
   //(Inizializzazione della logica
   bInitDone   := TRUE;
   bPwmOut   := FALSE;
   bNewPeriod   := FALSE;
   nPwmActCycleTick := 0;
   // controllo i valori impostati
   // in caso che valgano 0 genero un errore =2 ed esco
   IF ( fCtrtime <= 0.0 ) OR ( fPlcTime <= 0.0 ) THEN
      begin
      ntyperr := nERR_INVALIDPARAM;
      exit;
   END;

   // controllo i valori impostati
   // in caso che fctrTime sia più piccolo di fplcTime genero un errore =3 ed esco

   IF ( fCtrTime <= fPlcTime ) THEN
      begin
      ntyperr := nERR_INVALIDCYCLETIME;
      exit;
   END;

   //se arrivo qui vuol dire che non ci sono stati errori
   //setto i cicli della modulazione PWM
   nPwmCycleTicks  := ValMAX( 1,( fCtrTime / fPlcTime ) );
   fPwmCycleTime  := nPwmCycleTicks * fPlcTime;

   // setto i flag interno
   bInit   := TRUE;

END;

// fine fase di inizializzazione

//resetto la variabile di errore
nTypErr := nERR_NOERROR;


//modulo di calcolo
nPwmActCycleTick := nPwmActCycleTick + 1;
IF ( nPwmActCycleTick >= nPwmCycleTicks ) THEN
   begin
   nPwmActCycleTick := 0;
   bNewPeriod   := TRUE;
   end
ELSE
   begin
   bNewPeriod   := FALSE;
END;


//Nuova modulazione uscita PWM
IF bNewPeriod THEN
   begin
   nPowerOnCycleTicks := ( nPwmCycleTicks * VALMIN( 100.0, VALMAX( 0.0, fPwmIn ) ) / 100.0 );
   nPowerOffCycleTicks := nPwmCycleTicks - nPowerOnCycleTicks;
END;


//scrivo l'uscita digitale per la modulazione PWM
IF ( nPwmActCycleTick < nPowerOnCycleTicks ) THEN
   begin
   bPwmOut := TRUE;
   end
ELSE
    begin
    bPwmOut := FALSE;
END;

//Fine modulo

END;