Monitor mode exploration

Dependencies:   mbed-rtos mbed

main.cpp

Committer:
jvanhook
Date:
2014-06-17
Revision:
4:913c3147f211
Parent:
3:d84f98b6920e

File content as of revision 4:913c3147f211:

/* Includes ------------------------------------------------------------------- */
#include "mbed.h"              
#include "rtos.h"
#include "lpc17xx_i2c.h"
#include "lpc17xx_clkpwr.h"
#include "lpc17xx_pinsel.h"

/* If this source file built with example, the LPC17xx FW library configuration
* file in each example directory ("lpc17xx_libcfg.h") must be included,
* otherwise the default FW library configuration file must be included instead
*/

#ifdef __BUILD_WITH_EXAMPLE__
#include "lpc17xx_libcfg.h"
#else
#include "lpc17xx_libcfg_default.h"
#endif /* __BUILD_WITH_EXAMPLE__ */


#ifdef _I2C

  

DigitalOut myled1(LED1);
DigitalOut myled2(LED2);
DigitalOut myled3(LED3);
DigitalOut myled4(LED4);
 
Serial pc(USBTX, USBRX); // tx, rx
 
 
 void blinky(void const *args)
{
        while(1){
        myled1 = 1;
        Thread::wait(100);     //wait(.1); 
        myled1 = 0;

        myled2 = 1;      
        Thread::wait(100);     //wait(.1);
        myled2 = 0;

        myled3 = 1;
        Thread::wait(100);     //wait(.1);
        myled3 = 0;

        myled4 = 1;
        Thread::wait(100);     //wait(.1);
        myled4 = 0;

        myled3 = 1;
        Thread::wait(100);     //wait(.1);
        myled3 = 0;

        myled2 = 1;
        wait(.1);
        myled2 = 0;
        }
    }




/* Private Types -------------------------------------------------------------- */
/** @defgroup I2C_Private_Types
* @{
*/

/**
* @brief I2C device configuration structure type
*/
typedef struct {
    uint32_t txrx_setup; /* Transmission setup */
    int32_t   dir;    /* Current direction phase, 0 - write, 1 - read */
    void  (*inthandler)(LPC_I2C_TypeDef *I2Cx); /* Transmission interrupt handler */
} I2C_CFG_T;

/**
* @}
*/

/* Private Variables ---------------------------------------------------------- */
/**
* @brief II2C driver data for I2C0, I2C1 and I2C2
*/
static I2C_CFG_T i2cdat[3];



/* Private Functions ---------------------------------------------------------- */
/** @defgroup I2C_Private_Functions
* @{
*/

/* Generate a start condition on I2C bus (in master mode only) */
static uint32_t I2C_Start (LPC_I2C_TypeDef *I2Cx);

/* Generate a stop condition on I2C bus (in master mode only) */
static void I2C_Stop (LPC_I2C_TypeDef *I2Cx);

/* I2C send byte subroutine */
static uint32_t I2C_SendByte (LPC_I2C_TypeDef *I2Cx, uint8_t databyte);

/* I2C get byte subroutine */
static uint32_t I2C_GetByte (LPC_I2C_TypeDef *I2Cx, uint8_t *retdat, Bool ack);

/* I2C interrupt master handler */
void I2C_MasterHandler (LPC_I2C_TypeDef *I2Cx);

/* I2C interrupt slave handler */
void I2C_SlaveHandler (LPC_I2C_TypeDef *I2Cx);

/* Enable interrupt for I2C device */
void I2C_IntCmd (LPC_I2C_TypeDef *I2Cx, Bool NewState);

/*--------------------------------------------------------------------------------*/

/**
* @brief Convert from I2C peripheral to number
*/
static int32_t I2C_getNum(LPC_I2C_TypeDef *I2Cx)
{
    if (I2Cx == LPC_I2C0) {
        return (0);
    } else if (I2Cx == LPC_I2C1) {
        return (1);
    } else if (I2Cx == LPC_I2C2) {
        return (2);
    }
    return (-1);
}

/***********************************************************************
* Function: I2C_Start
* Purpose: Generate a start condition on I2C bus (in master mode only)
* Parameters:
* i2cdev: Pointer to I2C register
* blocking: blocking or none blocking mode
* Returns: value of I2C status register after generate a start condition
**********************************************************************/
static uint32_t I2C_Start (LPC_I2C_TypeDef *I2Cx)
{
    I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
    I2Cx->I2CONSET = I2C_I2CONSET_STA;

// Wait for complete
    while (!(I2Cx->I2CONSET & I2C_I2CONSET_SI));
    I2Cx->I2CONCLR = I2C_I2CONCLR_STAC;
    return (I2Cx->I2STAT & I2C_STAT_CODE_BITMASK);
}


/***********************************************************************
* Function: I2C_Stop
* Purpose: Generate a stop condition on I2C bus (in master mode only)
* Parameters:
* I2Cx: Pointer to I2C register
* Returns: None
**********************************************************************/
static void I2C_Stop (LPC_I2C_TypeDef *I2Cx)
{

    /* Make sure start bit is not active */
    if (I2Cx->I2CONSET & I2C_I2CONSET_STA) {
        I2Cx->I2CONCLR = I2C_I2CONCLR_STAC;
    }
    I2Cx->I2CONSET = I2C_I2CONSET_STO;
    I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
}


/***********************************************************************
* Function: I2C_SendByte
* Purpose: Send a byte
* Parameters:
* I2Cx: Pointer to I2C register
* Returns: value of I2C status register after sending
**********************************************************************/
static uint32_t I2C_SendByte (LPC_I2C_TypeDef *I2Cx, uint8_t databyte)
{
    /* Make sure start bit is not active */
    if (I2Cx->I2CONSET & I2C_I2CONSET_STA) {
        I2Cx->I2CONCLR = I2C_I2CONCLR_STAC;
    }
    I2Cx->I2DAT = databyte & I2C_I2DAT_BITMASK;
    I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;

    while (!(I2Cx->I2CONSET & I2C_I2CONSET_SI));
    return (I2Cx->I2STAT & I2C_STAT_CODE_BITMASK);
}


/***********************************************************************
* Function: I2C_GetByte
* Purpose: Get a byte
* Parameters:
* I2Cx: Pointer to I2C register
* Returns: value of I2C status register after receiving
**********************************************************************/
static uint32_t I2C_GetByte (LPC_I2C_TypeDef *I2Cx, uint8_t *retdat, Bool ack)
{
    if (ack == TRUE) {
        I2Cx->I2CONSET = I2C_I2CONSET_AA;
    } else {
        I2Cx->I2CONCLR = I2C_I2CONCLR_AAC;
    }
    I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;

    while (!(I2Cx->I2CONSET & I2C_I2CONSET_SI));
    *retdat = (uint8_t) (I2Cx->I2DAT & I2C_I2DAT_BITMASK);
    return (I2Cx->I2STAT & I2C_STAT_CODE_BITMASK);
}



/*********************************************************************//**
* @brief Enable/Disable interrupt for I2C peripheral
* @param[in] I2Cx I2C peripheral selected, should be I2C0, I2C1 or I2C2
* @param[in] NewState New State of I2C peripheral interrupt in NVIC core
* should be:
* - ENABLE: enable interrupt for this I2C peripheral
* - DISABLE: disable interrupt for this I2C peripheral
* @return None
**********************************************************************/
void I2C_IntCmd (LPC_I2C_TypeDef *I2Cx, Bool NewState)
{
    if (NewState) {
        if(I2Cx == LPC_I2C0) {
            NVIC_EnableIRQ(I2C0_IRQn);
        } else if (I2Cx == LPC_I2C1) {
            NVIC_EnableIRQ(I2C1_IRQn);
        } else if (I2Cx == LPC_I2C2) {
            NVIC_EnableIRQ(I2C2_IRQn);
        }
    } else {
        if(I2Cx == LPC_I2C0) {
            NVIC_DisableIRQ(I2C0_IRQn);
        } else if (I2Cx == LPC_I2C1) {
            NVIC_DisableIRQ(I2C1_IRQn);
        } else if (I2Cx == LPC_I2C2) {
            NVIC_DisableIRQ(I2C2_IRQn);
        }
    }
    return;
}


/*********************************************************************//**
* @brief General Master Interrupt handler for I2C peripheral
* @param[in] I2Cx I2C peripheral selected, should be I2C0, I2C1 or I2C2
* @return None
**********************************************************************/
void I2C_MasterHandler (LPC_I2C_TypeDef *I2Cx)
{
    int32_t tmp;
    uint8_t returnCode;
    I2C_M_SETUP_Type *txrx_setup;

    tmp = I2C_getNum(I2Cx);
    txrx_setup = (I2C_M_SETUP_Type *) i2cdat[tmp].txrx_setup;

    returnCode = (I2Cx->I2STAT & I2C_STAT_CODE_BITMASK);
// Save current status
    txrx_setup->status = returnCode;
// there's no relevant information
    if (returnCode == I2C_I2STAT_NO_INF) {
        I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
        return;
    }

    /* ----------------------------- TRANSMIT PHASE --------------------------*/
    if (i2cdat[tmp].dir == 0) {
        switch (returnCode) {
                /* A start/repeat start condition has been transmitted -------------------*/
            case I2C_I2STAT_M_TX_START:
            case I2C_I2STAT_M_TX_RESTART:
                I2Cx->I2CONCLR = I2C_I2CONCLR_STAC;
                /*
                * If there's any transmit data, then start to
                * send SLA+W right now, otherwise check whether if there's
                * any receive data for next state.
                */
                if ((txrx_setup->tx_data != NULL) && (txrx_setup->tx_length != 0)) {
                    I2Cx->I2DAT = (txrx_setup->sl_addr7bit << 1);
                    I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
                } else {
                    goto next_stage;
                }
                break;

                /* SLA+W has been transmitted, ACK has been received ----------------------*/
            case I2C_I2STAT_M_TX_SLAW_ACK:
                /* Data has been transmitted, ACK has been received */
            case I2C_I2STAT_M_TX_DAT_ACK:
                /* Send more data */
                if ((txrx_setup->tx_count < txrx_setup->tx_length) \
                        && (txrx_setup->tx_data != NULL)) {
                    I2Cx->I2DAT = *(uint8_t *)(txrx_setup->tx_data + txrx_setup->tx_count);
                    txrx_setup->tx_count++;
                    I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
                }
// no more data, switch to next stage
                else {
next_stage:
// change direction
                    i2cdat[tmp].dir = 1;
// Check if any data to receive
                    if ((txrx_setup->rx_length != 0) && (txrx_setup->rx_data != NULL)) {
// check whether if we need to issue an repeat start
                        if ((txrx_setup->tx_length != 0) && (txrx_setup->tx_data != NULL)) {
// Send out an repeat start command
                            I2Cx->I2CONSET = I2C_I2CONSET_STA;
                            I2Cx->I2CONCLR = I2C_I2CONCLR_AAC | I2C_I2CONCLR_SIC;
                        }
// Don't need issue an repeat start, just goto send SLA+R
                        else {
                            goto send_slar;
                        }
                    }
// no more data send, the go to end stage now
                    else {
// success, goto end stage
                        txrx_setup->status |= I2C_SETUP_STATUS_DONE;
                        goto end_stage;
                    }
                }
                break;

                /* SLA+W has been transmitted, NACK has been received ----------------------*/
            case I2C_I2STAT_M_TX_SLAW_NACK:
                /* Data has been transmitted, NACK has been received -----------------------*/
            case I2C_I2STAT_M_TX_DAT_NACK:
// update status
                txrx_setup->status |= I2C_SETUP_STATUS_NOACKF;
                goto retry;
                //break;
                /* Arbitration lost in SLA+R/W or Data bytes -------------------------------*/
            case I2C_I2STAT_M_TX_ARB_LOST:
// update status
                txrx_setup->status |= I2C_SETUP_STATUS_ARBF;
            default:
                goto retry;
                //break;
        }
    }

    /* ----------------------------- RECEIVE PHASE --------------------------*/
    else if (i2cdat[tmp].dir == 1) {
        switch (returnCode) {
                /* A start/repeat start condition has been transmitted ---------------------*/
            case I2C_I2STAT_M_RX_START:
            case I2C_I2STAT_M_RX_RESTART:
                I2Cx->I2CONCLR = I2C_I2CONCLR_STAC;
                /*
                * If there's any receive data, then start to
                * send SLA+R right now, otherwise check whether if there's
                * any receive data for end of state.
                */
                if ((txrx_setup->rx_data != NULL) && (txrx_setup->rx_length != 0)) {
send_slar:
                    I2Cx->I2DAT = (txrx_setup->sl_addr7bit << 1) | 0x01;
                    I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
                } else {
// Success, goto end stage
                    txrx_setup->status |= I2C_SETUP_STATUS_DONE;
                    goto end_stage;
                }
                break;

                /* SLA+R has been transmitted, ACK has been received -----------------*/
            case I2C_I2STAT_M_RX_SLAR_ACK:
                if (txrx_setup->rx_count < (txrx_setup->rx_length - 1)) {
                    /*Data will be received, ACK will be return*/
                    I2Cx->I2CONSET = I2C_I2CONSET_AA;
                } else {
                    /*Last data will be received, NACK will be return*/
                    I2Cx->I2CONCLR = I2C_I2CONSET_AA;
                }
                I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
                break;

                /* Data has been received, ACK has been returned ----------------------*/
            case I2C_I2STAT_M_RX_DAT_ACK:
// Note save data and increase counter first, then check later
                /* Save data */
                if ((txrx_setup->rx_data != NULL) && (txrx_setup->rx_count < txrx_setup->rx_length)) {
                    *(uint8_t *)(txrx_setup->rx_data + txrx_setup->rx_count) = (I2Cx->I2DAT & I2C_I2DAT_BITMASK);
                    txrx_setup->rx_count++;
                }
                if (txrx_setup->rx_count < (txrx_setup->rx_length - 1)) {
                    /*Data will be received, ACK will be return*/
                    I2Cx->I2CONSET = I2C_I2CONSET_AA;
                } else {
                    /*Last data will be received, NACK will be return*/
                    I2Cx->I2CONCLR = I2C_I2CONSET_AA;
                }

                I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
                break;

                /* Data has been received, NACK has been return -------------------------*/
            case I2C_I2STAT_M_RX_DAT_NACK:
                /* Save the last data */
                if ((txrx_setup->rx_data != NULL) && (txrx_setup->rx_count < txrx_setup->rx_length)) {
                    *(uint8_t *)(txrx_setup->rx_data + txrx_setup->rx_count) = (I2Cx->I2DAT & I2C_I2DAT_BITMASK);
                    txrx_setup->rx_count++;
                }
// success, go to end stage
                txrx_setup->status |= I2C_SETUP_STATUS_DONE;
                goto end_stage;
                //break;

                /* SLA+R has been transmitted, NACK has been received ------------------*/
            case I2C_I2STAT_M_RX_SLAR_NACK:
// update status
                txrx_setup->status |= I2C_SETUP_STATUS_NOACKF;
                goto retry;
                //break;

                /* Arbitration lost ----------------------------------------------------*/
            case I2C_I2STAT_M_RX_ARB_LOST:
// update status
                txrx_setup->status |= I2C_SETUP_STATUS_ARBF;
            default:
retry:
// check if retransmission is available
                if (txrx_setup->retransmissions_count < txrx_setup->retransmissions_max) {
// Clear tx count
                    txrx_setup->tx_count = 0;
                    I2Cx->I2CONSET = I2C_I2CONSET_STA;
                    I2Cx->I2CONCLR = I2C_I2CONCLR_AAC | I2C_I2CONCLR_SIC;
                    txrx_setup->retransmissions_count++;
                }
// End of stage
                else {
end_stage:
// Disable interrupt
                    I2C_IntCmd(I2Cx, FALSE);
// Send stop
                    I2C_Stop(I2Cx);
// Call callback if installed
                    if (txrx_setup->callback != NULL) {
                        txrx_setup->callback();
                    }
                }
                break;
        }
    }
}


/*********************************************************************//**
* @brief General Slave Interrupt handler for I2C peripheral
* @param[in] I2Cx I2C peripheral selected, should be I2C0, I2C1 or I2C2
* @return None
**********************************************************************/
void I2C_SlaveHandler (LPC_I2C_TypeDef *I2Cx)
{
    int32_t tmp =0;
    uint8_t returnCode;
    I2C_S_SETUP_Type *txrx_setup;
    uint32_t timeout;

    pc.printf("INT\n\r");
    
    tmp = I2C_getNum(I2Cx);
    txrx_setup = (I2C_S_SETUP_Type *) i2cdat[tmp].txrx_setup;

    returnCode = (I2Cx->I2STAT & I2C_STAT_CODE_BITMASK);
// Save current status
    txrx_setup->status = returnCode;
// there's no relevant information
    if (returnCode == I2C_I2STAT_NO_INF) {
        I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
        pc.printf("No Data!\n\r");
        return;
    }


    switch (returnCode) {

            /* No status information */
        case I2C_I2STAT_NO_INF:
            I2Cx->I2CONSET = I2C_I2CONSET_AA;
            I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
            break;

            /* Reading phase -------------------------------------------------------- */
            /* Own SLA+R has been received, ACK has been returned */
        case I2C_I2STAT_S_RX_SLAW_ACK:
            /* General call address has been received, ACK has been returned */
        case I2C_I2STAT_S_RX_GENCALL_ACK:
            I2Cx->I2CONSET = I2C_I2CONSET_AA;
            I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
            break;

            /* Previously addressed with own SLA;
            * DATA byte has been received;
            * ACK has been returned */
        case I2C_I2STAT_S_RX_PRE_SLA_DAT_ACK:
            /* DATA has been received, ACK hasn been return */
        case I2C_I2STAT_S_RX_PRE_GENCALL_DAT_ACK:
            /*
            * All data bytes that over-flow the specified receive
            * data length, just ignore them.
            */
            if ((txrx_setup->rx_count < txrx_setup->rx_length) \
                    && (txrx_setup->rx_data != NULL)) {
                *(uint8_t *)(txrx_setup->rx_data + txrx_setup->rx_count) = (uint8_t)I2Cx->I2DAT;
                txrx_setup->rx_count++;
            }
            I2Cx->I2CONSET = I2C_I2CONSET_AA;
            I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
            break;

            /* Previously addressed with own SLA;
            * DATA byte has been received;
            * NOT ACK has been returned */
        case I2C_I2STAT_S_RX_PRE_SLA_DAT_NACK:
            /* DATA has been received, NOT ACK has been returned */
        case I2C_I2STAT_S_RX_PRE_GENCALL_DAT_NACK:
            I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
            break;

            /*
            * Note that: Return code only let us know a stop condition mixed
            * with a repeat start condition in the same code value.
            * So we should provide a time-out. In case this is really a stop
            * condition, this will return back after time out condition. Otherwise,
            * next session that is slave receive data will be completed.
            */

            /* A Stop or a repeat start condition */
        case I2C_I2STAT_S_RX_STA_STO_SLVREC_SLVTRX:
// Temporally lock the interrupt for timeout condition
            I2C_IntCmd(I2Cx, FALSE);
            I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
// enable time out
            timeout = I2C_SLAVE_TIME_OUT;
            while(1) {
                if (I2Cx->I2CONSET & I2C_I2CONSET_SI) {
// re-Enable interrupt
                    I2C_IntCmd(I2Cx, TRUE);
                    break;
                } else {
                    timeout--;
                    if (timeout == 0) {
// timeout occur, it's really a stop condition
                        txrx_setup->status |= I2C_SETUP_STATUS_DONE;
                        goto s_int_end;
                    }
                }
            }
            break;

            /* Writing phase -------------------------------------------------------- */
            /* Own SLA+R has been received, ACK has been returned */
        case I2C_I2STAT_S_TX_SLAR_ACK:
            /* Data has been transmitted, ACK has been received */
        case I2C_I2STAT_S_TX_DAT_ACK:
            /*
            * All data bytes that over-flow the specified receive
            * data length, just ignore them.
            */
            if ((txrx_setup->tx_count < txrx_setup->tx_length) \
                    && (txrx_setup->tx_data != NULL)) {
                I2Cx->I2DAT = *(uint8_t *) (txrx_setup->tx_data + txrx_setup->tx_count);
                txrx_setup->tx_count++;
            }
            I2Cx->I2CONSET = I2C_I2CONSET_AA;
            I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
            break;

            /* Data has been transmitted, NACK has been received,
            * that means there's no more data to send, exit now */
            /*
            * Note: Don't wait for stop event since in slave transmit mode,
            * since there no proof lets us know when a stop signal has been received
            * on slave side.
            */
        case I2C_I2STAT_S_TX_DAT_NACK:
            I2Cx->I2CONSET = I2C_I2CONSET_AA;
            I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
            txrx_setup->status |= I2C_SETUP_STATUS_DONE;
            goto s_int_end;
            //break;

// Other status must be captured
        default:
s_int_end:
// Disable interrupt
            I2C_IntCmd(I2Cx, FALSE);
            I2Cx->I2CONCLR = I2C_I2CONCLR_AAC | I2C_I2CONCLR_SIC | I2C_I2CONCLR_STAC;
// Call callback if installed
            if (txrx_setup->callback != NULL) {
                txrx_setup->callback();
            }
            break;
    }
}

/**
* @}
*/


/* Public Functions ----------------------------------------------------------- */
/** @addtogroup I2C_Public_Functions
* @{
*/

/*********************************************************************//**
* @brief Setup clock rate for I2C peripheral
* @param[in] I2Cx I2C peripheral selected, should be I2C0, I2C1 or I2C2
* @param[in] target_clock : clock of SSP (Hz)
* @return None
***********************************************************************/
void I2C_SetClock (LPC_I2C_TypeDef *I2Cx, uint32_t target_clock) // * @brief Setup clock rate for I2C peripheral
{
    uint32_t temp=0;

if(target_clock <= 0) return; // guard ! don't div zero dummy ! ! 
// Get PCLK of I2C controller
    if (I2Cx == LPC_I2C0) {
        temp = CLKPWR_GetPCLK (CLKPWR_PCLKSEL_I2C0) / target_clock;
    } else if (I2Cx == LPC_I2C1) {
        temp = CLKPWR_GetPCLK (CLKPWR_PCLKSEL_I2C1) / target_clock;
    } else if (I2Cx == LPC_I2C2) {
        temp = CLKPWR_GetPCLK (CLKPWR_PCLKSEL_I2C1) / target_clock;
    }

    /* Set the I2C clock value to register */
    I2Cx->I2SCLH = (uint32_t)(temp / 2);
    I2Cx->I2SCLL = (uint32_t)(temp - I2Cx->I2SCLH);
}


/*********************************************************************//**
* @brief De-initializes the I2C peripheral registers to their
* default reset values.
* @param[in] I2Cx I2C peripheral selected, should be I2C0, I2C1 or I2C2
* @return None
**********************************************************************/
void I2C_DeInit(LPC_I2C_TypeDef* I2Cx)
{
    
    /* Disable I2C control */
    I2Cx->I2CONCLR = I2C_I2CONCLR_I2ENC;

    if (I2Cx==LPC_I2C0) {
        /* Disable power for I2C0 module */
        CLKPWR_ConfigPPWR (CLKPWR_PCONP_PCI2C0, DISABLE);
    } else if (I2Cx==LPC_I2C1) {
        /* Disable power for I2C1 module */
        CLKPWR_ConfigPPWR (CLKPWR_PCONP_PCI2C1, DISABLE);
    } else if (I2Cx==LPC_I2C2) {
        /* Disable power for I2C2 module */
        CLKPWR_ConfigPPWR (CLKPWR_PCONP_PCI2C2, DISABLE);
    }
}
 

/********************************************************************//**
* @brief Initializes the I2Cx peripheral with specified parameter.
* @param[in] I2Cx I2C peripheral selected, should be I2C0, I2C1 or I2C2
* @param[in] clockrate Target clock rate value to initialized I2C
* peripheral
* @return None
*********************************************************************/
void I2C_Init(LPC_I2C_TypeDef *I2Cx, uint32_t clockrate)
{
    if (I2Cx==LPC_I2C0) {
        /* Set up clock and power for I2C0 module */
        CLKPWR_ConfigPPWR (CLKPWR_PCONP_PCI2C0, ENABLE);
        /* As default, peripheral clock for I2C0 module is set to FCCLK / 2 */
        CLKPWR_SetPCLKDiv(CLKPWR_PCLKSEL_I2C0, CLKPWR_PCLKSEL_CCLK_DIV_2);
    } else if (I2Cx==LPC_I2C1) {
        /* Set up clock and power for I2C1 module */
        CLKPWR_ConfigPPWR (CLKPWR_PCONP_PCI2C1, ENABLE);
        /* As default, peripheral clock for I2C1 module is set to FCCLK / 2 */
        CLKPWR_SetPCLKDiv(CLKPWR_PCLKSEL_I2C1, CLKPWR_PCLKSEL_CCLK_DIV_2);
    } else if (I2Cx==LPC_I2C2) {
        /* Set up clock and power for I2C2 module */
        CLKPWR_ConfigPPWR (CLKPWR_PCONP_PCI2C2, ENABLE);
        /* As default, peripheral clock for I2C2 module is set to FCCLK / 2 */
        CLKPWR_SetPCLKDiv(CLKPWR_PCLKSEL_I2C2, CLKPWR_PCLKSEL_CCLK_DIV_2);
    } else {
// Up-Support this device
        return;
    }

    /* Set clock rate */
    I2C_SetClock(I2Cx, clockrate);
    /* Set I2C operation to default */
    I2Cx->I2CONCLR = (I2C_I2CONCLR_AAC | I2C_I2CONCLR_STAC | I2C_I2CONCLR_I2ENC);
}


/*********************************************************************//**
* @brief Enable or disable I2C peripheral's operation
* @param[in] I2Cx I2C peripheral selected, should be I2C0, I2C1 or I2C2
* @param[in] NewState New State of I2Cx peripheral's operation
* @return none
**********************************************************************/
void I2C_Cmd(LPC_I2C_TypeDef* I2Cx, FunctionalState NewState)
{

    if (NewState == ENABLE) {
        I2Cx->I2CONSET = I2C_I2CONSET_I2EN;
    } else {
        I2Cx->I2CONCLR = I2C_I2CONCLR_I2ENC;
    }
}


/*********************************************************************//**
* @brief Transmit and Receive data in master mode
* @param[in] I2Cx I2C peripheral selected, should be I2C0, I2C1 or I2C2
* @param[in] TransferCfg Pointer to a I2C_M_SETUP_Type structure that
* contains specified information about the
* configuration for master transfer.
* @param[in] Opt a I2C_TRANSFER_OPT_Type type that selected for
* interrupt or polling mode.
* @return SUCCESS or ERROR
*
* Note:
* - In case of using I2C to transmit data only, either transmit length set to 0
* or transmit data pointer set to NULL.
* - In case of using I2C to receive data only, either receive length set to 0
* or receive data pointer set to NULL.
* - In case of using I2C to transmit followed by receive data, transmit length,
* transmit data pointer, receive length and receive data pointer should be set
* corresponding.
**********************************************************************/
Status I2C_MasterTransferData(LPC_I2C_TypeDef *I2Cx, I2C_M_SETUP_Type *TransferCfg, I2C_TRANSFER_OPT_Type Opt)
{
    uint8_t *txdat;
    uint8_t *rxdat;
    uint32_t CodeStatus;
    uint8_t tmp;

// reset all default state
    txdat = (uint8_t *) TransferCfg->tx_data;
    rxdat = (uint8_t *) TransferCfg->rx_data;
// Reset I2C setup value to default state
    TransferCfg->tx_count = 0;
    TransferCfg->rx_count = 0;
    TransferCfg->status = 0;

    if (Opt == I2C_TRANSFER_POLLING) {

        /* First Start condition -------------------------------------------------------------- */
        TransferCfg->retransmissions_count = 0;
retry:
// reset all default state
        txdat = (uint8_t *) TransferCfg->tx_data;
        rxdat = (uint8_t *) TransferCfg->rx_data;
// Reset I2C setup value to default state
        TransferCfg->tx_count = 0;
        TransferCfg->rx_count = 0;
        CodeStatus = 0;

// Start command
        CodeStatus = I2C_Start(I2Cx);
        if ((CodeStatus != I2C_I2STAT_M_TX_START) \
                && (CodeStatus != I2C_I2STAT_M_TX_RESTART)) {
            TransferCfg->retransmissions_count++;
            if (TransferCfg->retransmissions_count > TransferCfg->retransmissions_max) {
// save status
                TransferCfg->status = CodeStatus;
                goto error;
            } else {
                goto retry;
            }
        }

        /* In case of sending data first --------------------------------------------------- */
        if ((TransferCfg->tx_length != 0) && (TransferCfg->tx_data != NULL)) {

            /* Send slave address + WR direction bit = 0 ----------------------------------- */
            CodeStatus = I2C_SendByte(I2Cx, (TransferCfg->sl_addr7bit << 1));
            if (CodeStatus != I2C_I2STAT_M_TX_SLAW_ACK) {
                TransferCfg->retransmissions_count++;
                if (TransferCfg->retransmissions_count > TransferCfg->retransmissions_max) {
// save status
                    TransferCfg->status = CodeStatus | I2C_SETUP_STATUS_NOACKF;
                    goto error;
                } else {
                    goto retry;
                }
            }

            /* Send a number of data bytes ---------------------------------------- */
            while (TransferCfg->tx_count < TransferCfg->tx_length) {
                CodeStatus = I2C_SendByte(I2Cx, *txdat);
                if (CodeStatus != I2C_I2STAT_M_TX_DAT_ACK) {
                    TransferCfg->retransmissions_count++;
                    if (TransferCfg->retransmissions_count > TransferCfg->retransmissions_max) {
// save status
                        TransferCfg->status = CodeStatus | I2C_SETUP_STATUS_NOACKF;
                        goto error;
                    } else {
                        goto retry;
                    }
                }

                txdat++;
                TransferCfg->tx_count++;
            }
        }

        /* Second Start condition (Repeat Start) ------------------------------------------- */
        if ((TransferCfg->tx_length != 0) && (TransferCfg->tx_data != NULL) \
                && (TransferCfg->rx_length != 0) && (TransferCfg->rx_data != NULL)) {

            CodeStatus = I2C_Start(I2Cx);
            if ((CodeStatus != I2C_I2STAT_M_RX_START) \
                    && (CodeStatus != I2C_I2STAT_M_RX_RESTART)) {
                TransferCfg->retransmissions_count++;
                if (TransferCfg->retransmissions_count > TransferCfg->retransmissions_max) {
// Update status
                    TransferCfg->status = CodeStatus;
                    goto error;
                } else {
                    goto retry;
                }
            }
        }

        /* Then, start reading after sending data -------------------------------------- */
        if ((TransferCfg->rx_length != 0) && (TransferCfg->rx_data != NULL)) {
            /* Send slave address + RD direction bit = 1 ----------------------------------- */

            CodeStatus = I2C_SendByte(I2Cx, ((TransferCfg->sl_addr7bit << 1) | 0x01));
            if (CodeStatus != I2C_I2STAT_M_RX_SLAR_ACK) {
                TransferCfg->retransmissions_count++;
                if (TransferCfg->retransmissions_count > TransferCfg->retransmissions_max) {
// update status
                    TransferCfg->status = CodeStatus | I2C_SETUP_STATUS_NOACKF;
                    goto error;
                } else {
                    goto retry;
                }
            }

            /* Receive a number of data bytes ------------------------------------------------- */
            while (TransferCfg->rx_count < TransferCfg->rx_length) {

                /*
                * Note that: if data length is only one, the master should not
                * issue an ACK signal on bus after reading to avoid of next data frame
                * on slave side
                */
                if (TransferCfg->rx_count < (TransferCfg->rx_length - 1)) {
// Issue an ACK signal for next data frame
                    CodeStatus = I2C_GetByte(I2Cx, &tmp, TRUE);
                    if (CodeStatus != I2C_I2STAT_M_RX_DAT_ACK) {
                        TransferCfg->retransmissions_count++;
                        if (TransferCfg->retransmissions_count > TransferCfg->retransmissions_max) {
// update status
                            TransferCfg->status = CodeStatus;
                            goto error;
                        } else {
                            goto retry;
                        }
                    }
                } else {
// Do not issue an ACK signal
                    CodeStatus = I2C_GetByte(I2Cx, &tmp, FALSE);
                    if (CodeStatus != I2C_I2STAT_M_RX_DAT_NACK) {
                        TransferCfg->retransmissions_count++;
                        if (TransferCfg->retransmissions_count > TransferCfg->retransmissions_max) {
// update status
                            TransferCfg->status = CodeStatus;
                            goto error;
                        } else {
                            goto retry;
                        }
                    }
                }
                *rxdat++ = tmp;
                TransferCfg->rx_count++;
            }
        }

        /* Send STOP condition ------------------------------------------------- */
        I2C_Stop(I2Cx);
        return SUCCESS;

error:
// Send stop condition
        I2C_Stop(I2Cx);
        return ERROR;
    }

    else if (Opt == I2C_TRANSFER_INTERRUPT) {
// Setup tx_rx data, callback and interrupt handler
        tmp = I2C_getNum(I2Cx);
        i2cdat[tmp].txrx_setup = (uint32_t) TransferCfg;
        i2cdat[tmp].inthandler = I2C_MasterHandler;
// Set direction phase, write first
        i2cdat[tmp].dir = 0;

        /* First Start condition -------------------------------------------------------------- */
        I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
        I2Cx->I2CONSET = I2C_I2CONSET_STA;
        I2C_IntCmd(I2Cx, TRUE);

        return (SUCCESS);
    }

    return ERROR;
}

/*********************************************************************//**
* @brief Receive and Transmit data in slave mode
* @param[in] I2Cx I2C peripheral selected, should be I2C0, I2C1 or I2C2
* @param[in] TransferCfg Pointer to a I2C_S_SETUP_Type structure that
* contains specified information about the
* configuration for master transfer.
* @param[in] Opt I2C_TRANSFER_OPT_Type type that selected for
* interrupt or polling mode.
* @return SUCCESS or ERROR
*
* Note:
* The mode of slave's operation depends on the command sent from master on
* the I2C bus. If the master send a SLA+W command, this sub-routine will
* use receive data length and receive data pointer. If the master send a SLA+R
* command, this sub-routine will use transmit data length and transmit data
* pointer.
* If the master issue an repeat start command or a stop command, the slave will
* enable an time out condition, during time out condition, if there's no activity
* on I2C bus, the slave will exit, otherwise (i.e. the master send a SLA+R/W),
* the slave then switch to relevant operation mode. The time out should be used
* because the return status code can not show difference from stop and repeat
* start command in slave operation.
* In case of the expected data length from master is greater than data length
* that slave can support:
* - In case of reading operation (from master): slave will return I2C_I2DAT_IDLE_CHAR
* value.
* - In case of writing operation (from master): slave will ignore remain data from master.
**********************************************************************/
Status I2C_SlaveTransferData(LPC_I2C_TypeDef *I2Cx, I2C_S_SETUP_Type *TransferCfg, \
                             I2C_TRANSFER_OPT_Type Opt)
{
    uint8_t *txdat;
    uint8_t *rxdat;
    uint32_t CodeStatus=0;
    uint32_t timeout;
    int32_t time_en;
    int32_t tmp;

// reset all default state
    txdat = (uint8_t *) TransferCfg->tx_data;
    rxdat = (uint8_t *) TransferCfg->rx_data;
// Reset I2C setup value to default state
    TransferCfg->tx_count = 0;
    TransferCfg->rx_count = 0;
    TransferCfg->status = 0;


// Polling option
    if (Opt == I2C_TRANSFER_POLLING) {

        /* Set AA bit to ACK command on I2C bus */
        I2Cx->I2CONSET = I2C_I2CONSET_AA;
        /* Clear SI bit to be ready ... */
        I2Cx->I2CONCLR = (I2C_I2CONCLR_SIC | I2C_I2CONCLR_STAC);

        time_en = 0;
        timeout = 0;

        while (1) {
            /* Check SI flag ready */
            if (I2Cx->I2CONSET & I2C_I2CONSET_SI) {
                time_en = 0;

                switch (CodeStatus = (I2Cx->I2STAT & I2C_STAT_CODE_BITMASK)) {

                        /* No status information */
                    case I2C_I2STAT_NO_INF:
                        I2Cx->I2CONSET = I2C_I2CONSET_AA;
                        I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
                        break;

                        /* Reading phase -------------------------------------------------------- */
                        /* Own SLA+R has been received, ACK has been returned */
                    case I2C_I2STAT_S_RX_SLAW_ACK:
                        /* General call address has been received, ACK has been returned */
                    case I2C_I2STAT_S_RX_GENCALL_ACK:
                        I2Cx->I2CONSET = I2C_I2CONSET_AA;
                        I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
                        break;

                        /* Previously addressed with own SLA;
                        * DATA byte has been received;
                        * ACK has been returned */
                    case I2C_I2STAT_S_RX_PRE_SLA_DAT_ACK:
                        /* DATA has been received, ACK hasn been return */
                    case I2C_I2STAT_S_RX_PRE_GENCALL_DAT_ACK:
                        /*
                        * All data bytes that over-flow the specified receive
                        * data length, just ignore them.
                        */
                        if ((TransferCfg->rx_count < TransferCfg->rx_length) \
                                && (TransferCfg->rx_data != NULL)) {
                            *rxdat++ = (uint8_t)I2Cx->I2DAT;
                            TransferCfg->rx_count++;
                        }
                        I2Cx->I2CONSET = I2C_I2CONSET_AA;
                        I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
                        break;

                        /* Previously addressed with own SLA;
                        * DATA byte has been received;
                        * NOT ACK has been returned */
                    case I2C_I2STAT_S_RX_PRE_SLA_DAT_NACK:
                        /* DATA has been received, NOT ACK has been returned */
                    case I2C_I2STAT_S_RX_PRE_GENCALL_DAT_NACK:
                        I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
                        break;

                        /*
                        * Note that: Return code only let us know a stop condition mixed
                        * with a repeat start condition in the same code value.
                        * So we should provide a time-out. In case this is really a stop
                        * condition, this will return back after time out condition. Otherwise,
                        * next session that is slave receive data will be completed.
                        */

                        /* A Stop or a repeat start condition */
                    case I2C_I2STAT_S_RX_STA_STO_SLVREC_SLVTRX:
                        I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
// enable time out
                        time_en = 1;
                        timeout = 0;
                        break;

                        /* Writing phase -------------------------------------------------------- */
                        /* Own SLA+R has been received, ACK has been returned */
                    case I2C_I2STAT_S_TX_SLAR_ACK:
                        /* Data has been transmitted, ACK has been received */
                    case I2C_I2STAT_S_TX_DAT_ACK:
                        /*
                        * All data bytes that over-flow the specified receive
                        * data length, just ignore them.
                        */
                        if ((TransferCfg->tx_count < TransferCfg->tx_length) \
                                && (TransferCfg->tx_data != NULL)) {
                            I2Cx->I2DAT = *txdat++;
                            TransferCfg->tx_count++;
                        }
                        I2Cx->I2CONSET = I2C_I2CONSET_AA;
                        I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
                        break;

                        /* Data has been transmitted, NACK has been received,
                        * that means there's no more data to send, exit now */
                        /*
                        * Note: Don't wait for stop event since in slave transmit mode,
                        * since there no proof lets us know when a stop signal has been received
                        * on slave side.
                        */
                    case I2C_I2STAT_S_TX_DAT_NACK:
                        I2Cx->I2CONSET = I2C_I2CONSET_AA;
                        I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
// enable time out
                        time_en = 1;
                        timeout = 0;
                        break;

// Other status must be captured
                    default:
                        I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
                        goto s_error;
                        //break;
                }
            } else if (time_en) {
                if (timeout++ > I2C_SLAVE_TIME_OUT) {
// it's really a stop condition, goto end stage
                    goto s_end_stage;
                }
            }
        }

s_end_stage:
        /* Clear AA bit to disable ACK on I2C bus */
        I2Cx->I2CONCLR = I2C_I2CONCLR_AAC;
// Check if there's no error during operation
// Update status
        TransferCfg->status = CodeStatus | I2C_SETUP_STATUS_DONE;
        return SUCCESS;

s_error:
        /* Clear AA bit to disable ACK on I2C bus */
        I2Cx->I2CONCLR = I2C_I2CONCLR_AAC;
// Update status
        TransferCfg->status = CodeStatus;
        return ERROR;
    }

    else if (Opt == I2C_TRANSFER_INTERRUPT) {
// Setup tx_rx data, callback and interrupt handler
        tmp = I2C_getNum(I2Cx);
        i2cdat[tmp].txrx_setup = (uint32_t) TransferCfg;
        i2cdat[tmp].inthandler = I2C_SlaveHandler;
// Set direction phase, read first
        i2cdat[tmp].dir = 1;

// Enable AA
        I2Cx->I2CONSET = I2C_I2CONSET_AA;
        I2Cx->I2CONCLR = I2C_I2CONCLR_SIC | I2C_I2CONCLR_STAC;
        I2C_IntCmd(I2Cx, TRUE);

        return (SUCCESS);
    }

    return ERROR;
}

/*********************************************************************//**
* @brief Set Own slave address in I2C peripheral corresponding to
* parameter specified in OwnSlaveAddrConfigStruct.
* @param[in] I2Cx I2C peripheral selected, should be I2C0, I2C1 or I2C2
* @param[in] OwnSlaveAddrConfigStruct Pointer to a I2C_OWNSLAVEADDR_CFG_Type
* structure that contains the configuration information for the
* specified I2C slave address.
* @return None
**********************************************************************/
void I2C_SetOwnSlaveAddr(LPC_I2C_TypeDef *I2Cx, I2C_OWNSLAVEADDR_CFG_Type *OwnSlaveAddrConfigStruct)
{
    uint32_t tmp;

    tmp = (((uint32_t)(OwnSlaveAddrConfigStruct->SlaveAddr_7bit << 1)) \
           | ((OwnSlaveAddrConfigStruct->GeneralCallState == ENABLE) ? 0x01 : 0x00))& I2C_I2ADR_BITMASK;
    switch (OwnSlaveAddrConfigStruct->SlaveAddrChannel) {
        case 0:
            I2Cx->I2ADR0 = tmp;
            I2Cx->I2MASK0 = I2C_I2MASK_MASK((uint32_t) \
                                            (OwnSlaveAddrConfigStruct->SlaveAddrMaskValue));
            break;
        case 1:
            I2Cx->I2ADR1 = tmp;
            I2Cx->I2MASK1 = I2C_I2MASK_MASK((uint32_t) \
                                            (OwnSlaveAddrConfigStruct->SlaveAddrMaskValue));
            break;
        case 2:
            I2Cx->I2ADR2 = tmp;
            I2Cx->I2MASK2 = I2C_I2MASK_MASK((uint32_t) \
                                            (OwnSlaveAddrConfigStruct->SlaveAddrMaskValue));
            break;
        case 3:
            I2Cx->I2ADR3 = tmp;
            I2Cx->I2MASK3 = I2C_I2MASK_MASK((uint32_t) \
                                            (OwnSlaveAddrConfigStruct->SlaveAddrMaskValue));
            break;
    }
}


/*********************************************************************//**
* @brief Configures functionality in I2C monitor mode
* @param[in] I2Cx I2C peripheral selected, should be I2C0, I2C1 or I2C2
* @param[in] MonitorCfgType Monitor Configuration type, should be:
* - I2C_MONITOR_CFG_SCL_OUTPUT: I2C module can 'stretch'
* the clock line (hold it low) until it has had time to
* respond to an I2C interrupt.
* - I2C_MONITOR_CFG_MATCHALL: When this bit is set to '1'
* and the I2C is in monitor mode, an interrupt will be
* generated on ANY address received.
* @param[in] NewState New State of this function, should be:
* - ENABLE: Enable this function.
* - DISABLE: Disable this function.
* @return None
**********************************************************************/
void I2C_MonitorModeConfig(LPC_I2C_TypeDef *I2Cx, uint32_t MonitorCfgType, FunctionalState NewState) // I2C_MONITOR_CFG_MATCHALL, TRUE
{
    if (NewState == ENABLE) {
        I2Cx->MMCTRL |= MonitorCfgType; // I2C_MONITOR_CFG_MATCHALL .. I2Cx->MMCTRL |= I2C_I2MMCTRL_MM_ENA
    } else {
        I2Cx->MMCTRL &= (~MonitorCfgType) & I2C_I2MMCTRL_BITMASK;
    }
}


/*********************************************************************//**
* @brief Enable/Disable I2C monitor mode
* @param[in] I2Cx I2C peripheral selected, should be I2C0, I2C1 or I2C2
* @param[in] NewState New State of this function, should be:
* - ENABLE: Enable monitor mode.
* - DISABLE: Disable monitor mode.
* @return None
**********************************************************************/
void I2C_MonitorModeCmd(LPC_I2C_TypeDef *I2Cx, FunctionalState NewState)
{
 
    if (NewState == ENABLE) {
        I2Cx->MMCTRL |= I2C_I2MMCTRL_MM_ENA;
    } else {
        I2Cx->MMCTRL &= (~I2C_I2MMCTRL_MM_ENA) & I2C_I2MMCTRL_BITMASK;
    }
}


/*********************************************************************//**
* @brief Get data from I2C data buffer in monitor mode.
* @param[in] I2Cx I2C peripheral selected, should be I2C0, I2C1 or I2C2
* @return None
* Note: In monitor mode, the I2C module may lose the ability to stretch
* the clock (stall the bus) if the ENA_SCL bit is not set. This means that
* the processor will have a limited amount of time to read the contents of
* the data received on the bus. If the processor reads the I2DAT shift
* register, as it ordinarily would, it could have only one bit-time to
* respond to the interrupt before the received data is overwritten by
* new data.
**********************************************************************/
uint8_t I2C_MonitorGetDatabuffer(LPC_I2C_TypeDef *I2Cx)
{
    return ((uint8_t)(I2Cx->I2DATA_BUFFER));
}

/*********************************************************************//**
* @brief Standard Interrupt handler for I2C0 peripheral
* @param[in] None
* @return None
**********************************************************************/
void I2C0_StdIntHandler(void)
{
    i2cdat[0].inthandler(LPC_I2C0);
}

/*********************************************************************//**
* @brief Standard Interrupt handler for I2C1 peripheral
* @param[in] None
* @return None
**********************************************************************/
void I2C1_StdIntHandler(void)
{
    i2cdat[1].inthandler(LPC_I2C1);
}

/*********************************************************************//**
* @brief Standard Interrupt handler for I2C2 peripheral
* @param[in] None
* @return None
**********************************************************************/
void I2C2_StdIntHandler(void)
{
    i2cdat[2].inthandler(LPC_I2C2);
}

/*********************************************************************//**
 * @brief        Get data from I2C data buffer in monitor mode.
 * @param[in]    I2Cx    I2C peripheral selected, should be
 *                - LPC_I2C0
 *                 - LPC_I2C1
 *                 - LPC_I2C2
 * @return        None
 * Note:    In monitor mode, the I2C module may lose the ability to stretch
 * the clock (stall the bus) if the ENA_SCL bit is not set. This means that
 * the processor will have a limited amount of time to read the contents of
 * the data received on the bus. If the processor reads the I2DAT shift
 * register, as it ordinarily would, it could have only one bit-time to
 * respond to the interrupt before the received data is overwritten by
 * new data.
 **********************************************************************
BOOL_8 I2C_MonitorHandler(LPC_I2C_TypeDef *I2Cx, uint8_t *buffer, uint32_t size)
{
    BOOL_8 ret=FALSE;

    I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;

    buffer[I2C_MonitorBufferIndex] = (uint8_t)(I2Cx->I2DATA_BUFFER);
    I2C_MonitorBufferIndex++;
    if(I2C_MonitorBufferIndex >= size)
    {
        ret = TRUE;
    }
    return ret;
}
*/
/**
* @}
*/

#endif /* _I2C */

/**
* @}
*/

int main() {
    
    Thread thread(blinky);
    // LPC_I2C1
    uint8_t myByte;
    int count =0;
    
    LPC_I2C_TypeDef *I2Cx = LPC_I2C2;
    

    I2C_Init(I2Cx,1000);                   //* @brief Initializes the I2Cx peripheral with specified parameter.
    I2C_Cmd(I2Cx, ENABLE);                  // * @brief Enable or disable I2C peripheral's operation
    I2C_MonitorModeCmd(I2Cx, ENABLE);       // * @brief Enable/Disable I2C monitor mode -- I2C_I2MMCTRL_MM_ENA
    I2C_MonitorModeConfig(I2Cx, I2C_MONITOR_CFG_MATCHALL, ENABLE); // Configure to catch on all addresses - I2C_MONITOR_CFG_MATCHALL
    
    //I2C_SetClock (LPC_I2C1, 1000);          // * @brief Setup clock rate for I2C peripheral
    I2Cx->MMCTRL |= I2C_I2MMCTRL_MM_ENA;        // enable monitor mode
    I2Cx->MMCTRL |= I2C_MONITOR_CFG_MATCHALL;   // I2C_MONITOR_CFG_MATCHALL 
    I2Cx->MMCTRL |= (1<<1);                     // Enable ENA_SCL bit
    I2Cx->I2CONSET |= I2C_I2CONSET_I2EN;        // Enable the i2c interface    
    I2C_IntCmd(I2Cx, TRUE);
    
    /* interrupt handler */
   // NVIC_EnableIRQ(I2C1_IRQn);
    pc.printf(" **************** **************** **************** **************** **************** \n\r");
    printf("I2Cx->MMCTRL == %x \n\r",I2Cx->MMCTRL);
    wait(3);    
    I2Cx->I2CONCLR =         I2C_I2CONSET_STA | I2C_I2CONCLR_STAC;
    while (1) {
//        pc.printf("dataBuff has %x in it , and the count is %x \n\r",myByte, count++);
        
        //uint8_t retdat;
        //pc.printf("Waiting for a Byte to come in\r\n");
        //uint32_t aWord = I2C_GetByte (LPC_I2C1, &retdat, FALSE);
        //pc.printf(" retDat = %x, stat = %x \n\r",retdat,aWord);       
        //pc.printf("Data Buffer *********** = %x !\n\r",I2Cx->I2DATA_BUFFER);
        I2Cx->I2CONCLR =         I2C_I2CONSET_STA | I2C_I2CONCLR_STAC;        
        
        
//        I2Cx->I2DATA_BUFFER = 0xff;
        
        pc.printf("Status    = %x\n\r",I2Cx->I2STAT & I2C_STAT_CODE_BITMASK);               
        pc.printf("I2CONSET  = %x\n\r",I2Cx->I2CONSET);                       
        pc.printf("Interrupt = %x\n\r",I2C_I2CONSET_SI & I2Cx->I2CONSET);      // what is the value of the interupt 
        pc.printf("I2C_I2CONSET_STA  = %x\n\r",I2Cx->I2CONSET & I2C_I2CONSET_STA); // I2C Status Register.                       
        pc.printf("I2C_I2CONCLR_STAC  = %x\n\r",I2Cx->I2CONSET & I2C_I2CONCLR_STAC);                    
        pc.printf("Data Byte = %x \n\r,", I2Cx->I2DAT & I2C_I2DAT_BITMASK);


//  0xFF into the DAT


        //pc.printf("the count is %x \n\r\n\r",count++);
        // Clear the interrupt flag
        I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
        wait(0.3); 
        
        // Check SI flag ready 
        if ((I2Cx->I2CONSET & I2C_I2CONSET_SI) ){
            //    if(1) {
                pc.printf("I2Cx->I2CONSET & I2C_I2CONSET_SI is true \r\n");
                myByte = I2C_MonitorGetDatabuffer(I2Cx);
                // Clear the interrupt flag
                I2Cx->I2CONCLR = I2C_I2CONCLR_SIC;
                pc.printf("dataBuff has %x in it , and the count is %x \n\r",myByte, count++);
            }        
            else {
                pc.printf("I2C_I2CONSET_SI not set count = %x \n\r",count++);
            }
        pc.printf(" **************** \n\r");
        wait(0.3);        

    }    
}










/*

//LPC_I2C1->I2CONCLR = 0x04;


While SI is set, the low period of the serial
clock on the SCL line is stretched, and the
serial transfer is suspended. When SCL is HIGH, it is unaffected by the state of the SI flag.
SI must be reset by software, by writing a 1
to the SIC bit in I2CONCLR register. The SI bit
should be cleared only after the required bit(s) has (have) been set and the value in I2DAT
has been loaded or read.
*/