src/slave_Silabs_C8051F342/CD_DigitalWave.c

/* Cd_DigitalWave.c */
/* Digital signals generation and frecuency measurement */

#include <C8051F340.h>
#include "CD_tools.h"
#include "CD_Link.h"
#include "CD_DigitalWave.h"

sbit linea_servo=P2^3;

unsigned int cuenta_desbordes;
volatile unsigned int cp_cuenta_desbordes;
volatile unsigned char cp_TH1,cp_TL1;
volatile unsigned char lock_DIF;


void CD_DigitalWave_Init (void) 
{

    /* Digital Output Frecuency *****************************/
    TR0=0;
    TF0=0;

        EA=0; //Deshabilitar las interrupcion
                //Programar el Timer 0

    CKCON &= 0xF8;  // para el Silabs C8051F340, 48 Mhz /48 -> 1uS por cuenta
    CKCON |= 0x02;

        
    TR0=0;
        TF0=0;
        TMOD&=0xF0;
        TMOD|=0x01;
        
                //Habilitar las interrupciones
        ET0=1;
        EA=1;

    /* Digital Input Frecuency *****************************/
        // desconectar interrupciones
        EA = 0;

    CKCON &= ~0x08; // timer 1 uses preescaler as defined for timer 0, that is 48 MHz/48 -> 1uS

        // programar el sistema del timer 1
        TR1=0;
    TF1=0;

        TMOD &= 0x0F;
        TMOD |= 0x10;   // control soft, modo 1, temporizador
    TH1=0;
        TL1=0;

    cuenta_desbordes = 0;

        ET1 = 1;

        // programar la interrupcion externa 0

        IT0 = 1;    // edge trigered
        IE0 = 0;

    IT01CF &= ~0x07; 
    IT01CF |= 0x03; /* P0.3 will be interrupt 0 input */

        EX0 = 1;    // enable INT0 interrupt

        // conectar interrupciones
        EA = 1;

    lock_DIF = 0;

    TR1 = 1;    /* start TIMER 1 */
}

volatile unsigned char high_h, high_l, low_h, low_l; /* timer reload values */

void CD_DOF (unsigned char *msg) large {

    unsigned char subdevice;
    unsigned int val;

    /* parse string values */
    if (CD_HexaStrTo_u8(msg, 2, &subdevice)) {
        CD_LinkMsgError(0x00);  /* bad subdevice */
        return; 
    };

    /* high time in uS*/
    if (CD_HexaStrTo_u16(msg+2, 4, &val)) {
        CD_LinkMsgError(0x00);  /* bad line */
        return; 
    };

    val = 65536 - val;
        high_l = val & 0xFF;
        high_h = val >>8;

    /* low time in uS*/
    if (CD_HexaStrTo_u16(msg+6, 4, &val)) {
        CD_LinkMsgError(0x00);  /* bad line */
        return; 
    };

    val = 65536 - val;
        low_l = val & 0xFF;
        low_h = val >> 8;


        //Cargo la 1º Cuenta y arranco
        linea_servo = 1;
        TL0=high_l;
        TH0=high_h;
        TR0=1;
    
    CD_LinkMsgOK();    
}


void CD_DIF (unsigned char *msg) large {

    unsigned char subdevice;
    unsigned long val;
    unsigned char i;

    char num[10];

    /* parse string values */
    if (CD_HexaStrTo_u8(msg, 2, &subdevice)) {
        CD_LinkMsgError(0x00);  /* bad subdevice */
        return; 
    };

    lock_DIF = 1;   /* avoid race condition */

    val = cp_cuenta_desbordes;
    val <<= 8;
    val |= cp_TH1;
    val <<= 8;
    val |= cp_TL1;

    lock_DIF = 0;

    if (val > 1000000L) {  // 1Hz
        val = 1;
    } else {
        val = 1000000L/val;
    }



    //val=1234567890;

    for (i=0;i<10;i++) {
        num[i]='0'+ val % 10;
        val /= 10;
    }

    CD_LinkTXStr("#!");
    for (i=0;i<10;i++) {
        CD_LinkTXChar(num[9-i]);
    }
    CD_LinkTXChar('\x0D');

}

//Rutina de servicio colgada de la interrupción del timer 0
//"Cuelga" de ahi porque hemos puesto interrupt 1
void Genera_cuenta_ISR (void) interrupt 1
{
        if(linea_servo==1) {
        //Hacer la tarea 
            linea_servo = 0;
        TR0=0;
        //Reprogramar el Timer
            TL0=low_l;
            TH0=low_h;
            TR0=1;
        } else {
        //Hacer la tarea 
            linea_servo = 1;
        //Reprogramar el Timer
            TR0=0;
            TL0=high_l;
            TH0=high_h;
            TR0=1;    
        }
}



/* race conditions should be studied here */

void timer1_ISR (void) interrupt 3 {   //para solucionar los 0v tenemos que contar los debordes a ojo para para obligar un flag de bajada

    if (cuenta_desbordes != 65535) {    // limitar los desbordes
        cuenta_desbordes++;
    }
}


void int0_ISR (void) interrupt 0 {

    TR1 = 0;

    if (lock_DIF == 0) {
        cp_TH1 = TH1;
            cp_TL1 = TL1;
            cp_cuenta_desbordes = cuenta_desbordes;
    }

    TH1 = 0;
    TL1 = 0;
    cuenta_desbordes = 0;

    TR1 = 1;
}

---