#include <irq.h>
#include <cc110x-defaultSettings.h>
#include <cc110x-reg.h>
#include <stdint.h>
#include <board.h>
#include <hwtimer.h>

/**************************************************************************************************
 * @fn          Strobe
 * @brief       Send command to radio.
 * @param       none
 * @return      none
 *************************************************************************************************/
uint8_t cc110x_strobe(uint8_t c)
{
    uint8_t statusByte = 0;
    uint16_t int_state, gdo_state;

    /* Check for valid strobe command */
    if ((c == 0xBD) || ((c > RF_SRES) && (c < RF_SNOP))) {
        int_state = disableIRQ();

        /* Clear the Status read flag */
        RF1AIFCTL1 &= ~(RFSTATIFG);

        /* Wait for radio to be ready for next instruction */
        while (!(RF1AIFCTL1 & RFINSTRIFG));

        /* Write the strobe instruction */
        if ((c > RF_SRES) && (c < RF_SNOP)) {

            gdo_state = cc110x_read_reg(IOCFG2); /* buffer IOCFG2 state */
            cc110x_write_reg(IOCFG2, 0x29); /* c-ready to GDO2 */

            RF1AINSTRB = c;

            if ((RF1AIN & 0x04) == 0x04) {		/* chip at sleep mode */
                if ((c == RF_SXOFF) || (c == RF_SPWD) || (c == RF_SWOR)) { }
                else {
                    while ((RF1AIN & 0x04) == 0x04);       			/* c-ready ? */

                    hwtimer_wait(RTIMER_TICKS(9800));	/* Delay for ~810usec at 12MHz CPU clock */
                }
            }

            cc110x_write_reg(IOCFG2, gdo_state); /* restore IOCFG2 setting */
        }
        else {	/* chip active mode */
            RF1AINSTRB = c;
        }

        statusByte = RF1ASTATB;

        while (!(RF1AIFCTL1 & RFSTATIFG));

        restoreIRQ(int_state);
    }

    return statusByte;
}


/***************************************************************************************************
 * @fn          cc110x_read_reg
 * @brief       Read byte from register.
 * @param       none
 * @return      none
 ***************************************************************************************************/
uint8_t cc110x_read_reg(uint8_t addr)
{
    unsigned char x;
    uint16_t int_state;

    int_state = disableIRQ();

    RF1AINSTR1B = (addr | RF_REGRD);
    x = RF1ADOUT1B;

    restoreIRQ(int_state);
    return x;
}


/**************************************************************************************************
 * @fn          cc110x_write_reg
 * @brief       Write byte to register.
 * @param       none
 * @return      none
 **************************************************************************************************/
void cc110x_write_reg(uint8_t addr, uint8_t value)
{
    volatile unsigned int i;
    uint16_t int_state;

    int_state = disableIRQ();

    while (!(RF1AIFCTL1 & RFINSTRIFG));      /* Wait for the Radio to be ready for the next instruction */

    RF1AINSTRW = ((addr | RF_REGWR) << 8) + value; /* Send address + Instruction */

    while (!(RFDINIFG & RF1AIFCTL1));

    i = RF1ADOUTB;                            /* Reset RFDOUTIFG flag which contains status byte */

    restoreIRQ(int_state);
}

uint8_t cc110x_read_status(uint8_t addr)
{
    unsigned char x;
    uint16_t int_state;

    int_state = disableIRQ();

    RF1AINSTR1B = (addr | RF_STATREGRD);
    x = RF1ADOUT1B;

    restoreIRQ(int_state);
    return x;
}

/****************************************************************************************************
 * @fn          cc110x_readburst_reg
 * @brief       Read sequence of bytes from register.
 * @param       none
 * @return      none
 ***************************************************************************************************/
void cc110x_readburst_reg(uint8_t addr, char *buffer, uint8_t count)
{
    unsigned int i;
    uint16_t int_state;

    int_state = disableIRQ();

    while (!(RF1AIFCTL1 & RFINSTRIFG));        /* Wait for the Radio to be ready for next instruction */

    RF1AINSTR1B = (addr | RF_REGRD);          /* Send address + Instruction */

    for (i = 0; i < (count - 1); i++) {
        while (!(RFDOUTIFG & RF1AIFCTL1));       /* Wait for the Radio Core to update the RF1ADOUTB reg */

        buffer[i] = RF1ADOUT1B;                 /* Read DOUT from Radio Core + clears RFDOUTIFG */
        /* Also initiates auo-read for next DOUT byte */
    }

    buffer[count - 1] = RF1ADOUT0B;           /* Store the last DOUT from Radio Core */

    restoreIRQ(int_state);
}

void cc110x_read_fifo(char *buffer, uint8_t count)
{
    unsigned int i;
    uint16_t int_state;

    int_state = disableIRQ();

    while (!(RF1AIFCTL1 & RFINSTRIFG));        /* Wait for the Radio to be ready for next instruction */

    RF1AINSTR1B = (RF_RXFIFORD);          /* Send address + Instruction */

    for (i = 0; i < (count - 1); i++) {
        while (!(RFDOUTIFG & RF1AIFCTL1));       /* Wait for the Radio Core to update the RF1ADOUTB reg */

        buffer[i] = RF1ADOUT1B;                 /* Read DOUT from Radio Core + clears RFDOUTIFG */
        /* Also initiates auo-read for next DOUT byte */
    }

    buffer[count - 1] = RF1ADOUT0B;           /* Store the last DOUT from Radio Core */

    restoreIRQ(int_state);
}
/***************************************************************************************************
 * @fn          cc110x_writeburst_reg
 * @brief       Write sequence of bytes to register.
 * @param       none
 * @return      none
 **************************************************************************************************/
uint8_t cc110x_writeburst_reg(uint8_t addr, char *buffer, uint8_t count)
{
    /* Write Burst works wordwise not bytewise - bug known already */
    unsigned char i;
    uint16_t int_state;

    int_state = disableIRQ();

    while (!(RF1AIFCTL1 & RFINSTRIFG));        /* Wait for the Radio to be ready for next instruction */

    RF1AINSTRW = ((addr | RF_REGWR) << 8) + buffer[0]; /* Send address + Instruction */

    for (i = 1; i < count; i++) {
        RF1ADINB = buffer[i];                   /* Send data */

        while (!(RFDINIFG & RF1AIFCTL1));        /* Wait for TX to finish */
    }

    i = RF1ADOUTB;                            /* Reset RFDOUTIFG flag which contains status byte */

    restoreIRQ(int_state);
    return count;
}