src/slave_Silabs_C8051F342/cds_digitalio.c

/* cds_digitalio.c 
   Digital input/output module
   Angel Perles. June 2009.

   used resources
    All ports

   dependencies


   IMPORTANT:

*/

#include "CD_Main.h"

#include <cds_digitalio.h>



/****************************************************************************/
/* DigitalOutputLine                                                        */
void cds_DOL(const unsigned char *msg) {
    
    uint8_t subdevice;
    uint8_t line;
    uint8_t value;

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

    if (CD_HexaStrTo_u8(msg+2, 2, &line)) {
        CD_LinkMsgError(CD_Error_DAQBadLine);  /* bad line */
        return; 
    };

    if (CD_HexaStrTo_u8(msg+4, 1, &value)) {    /* ARRGELAR PER PERFORMANCE MES ENDEVANT */
         CD_LinkMsgError(CD_Error_BadValue);  /* bad value */
         return; 
    };

        CD_LinkMsgError(cds_DAQWriteDigitalLine(subdevice ,line ,value));

    /* all worked OK */
    // CD_LinkMsgOK(); 
}


/****************************************************************************/
/* DigitalInputLine                                                         */
void cds_DIL(unsigned char *msg) {
    
    uint8_t subdevice;
    uint8_t line;
    uint8_t value;

        cd_Error retval;

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

    if (CD_HexaStrTo_u8(msg+2, 2, &line)) {
        CD_LinkMsgError(CD_Error_BadValue);  /* bad line */
        return; 
    };


        retval = cds_DAQReadDigitalLine(subdevice, line, &value);

        if (retval != CD_Error_NoError) {
                CD_LinkMsgError(retval);
        } else {
            if (value) {
            CD_LinkTXStr("#!1\x0D");
            } else {
            CD_LinkTXStr("#!0\x0D");
        }
        }

}





/****************************************************************************/
/* DigitalOutputPort                                                        */
void cds_DOP(const unsigned char *msg) {
    
    uint8_t subdevice;
    uint8_t value;

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

    if (CD_HexaStrTo_u8(msg+8, 2, &value)) {
         CD_LinkMsgError(CD_Error_BadValue);  /* bad value */
         return; 
    };

        CD_LinkMsgError(cds_DAQWriteDigitalPort(subdevice, value));

    /* all worked OK */
    //CD_LinkMsgOK();
}


/****************************************************************************/
/* DigitalOutputPort with mask                                                       */
void cds_DOM(const unsigned char *msg) {
    
    uint8_t subdevice;
    uint8_t value;
    uint8_t mask;

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

    /* value for the port */
    if (CD_HexaStrTo_u8(msg+8, 2, &value)) {
         CD_LinkMsgError(CD_Error_BadValue);  /* bad value */
         return; 
    };

    /* mask for the port */
    if (CD_HexaStrTo_u8(msg+16, 2, &mask)) {
         CD_LinkMsgError(CD_Error_BadValue);  /* bad value */
         return; 
    };

        CD_LinkMsgError(cds_DAQWriteDigitalPortMask(subdevice, value, mask));

    /* all worked OK */
    CD_LinkMsgOK();
}


/****************************************************************************/
/* DigitalInputPort                                                         */
void cds_DIP(unsigned char *msg) {
    
    uint8_t subdevice;
    uint8_t value;

    unsigned char resp[3];

        cd_Error retval;

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

        retval = cds_DAQReadDigitalPort(subdevice, &value);

        if (retval != CD_Error_NoError) {
                CD_LinkMsgError(retval);
        } else {
        /* send response */
            CD_u8_ToHexaStr(value, 2, resp);
        CD_LinkTXStr("#!000000");
        CD_LinkTXStr(resp);
        CD_LinkTXChar('\x0D');
        }

}


/* End of file */

---