/*
 This project is free software: you can redistribute it and/or modify
 it under the terms of the GNU General Public License as published by
 the Free Software Foundation, either version 3 of the License, or
 (at your option) any later version.

 Multiprotocol is distributed in the hope that it will be useful,
 but WITHOUT ANY WARRANTY; without even the implied warranty of
 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 GNU General Public License for more details.

 You should have received a copy of the GNU General Public License
 along with Multiprotocol.  If not, see <http://www.gnu.org/licenses/>.
 */
//-------------------------------
//-------------------------------
//CC2500 SPI routines
//-------------------------------
//-------------------------------
#include <stdint.h>
#include "pins.h"
#include "cc2500_spi.h"
#include "spi.h"

void CC2500_WriteReg(uint8_t address, uint8_t data)
{
    CC25_CSN_off;
    SPI_Write(address);
    NOP();
    SPI_Write(data);
    CC25_CSN_on;
}

void CC2500_ReadRegisterMulti(uint8_t address, uint8_t data[], uint8_t length)
{
    CC25_CSN_off;
    SPI_Write(CC2500_READ_BURST | address);
    for(uint8_t i = 0; i < length; i++)
        data[i] = SPI_Read();
    CC25_CSN_on;
}

uint8_t CC2500_ReadReg(uint8_t address)
{
    uint8_t result;
    CC25_CSN_off;
    SPI_Write(CC2500_READ_SINGLE | address);
    result = SPI_Read();
    CC25_CSN_on;
    return(result);
}

void CC2500_ReadData(uint8_t *dpbuffer, uint8_t len)
{
    CC2500_ReadRegisterMulti(CC2500_3F_RXFIFO, dpbuffer, len);
}

void CC2500_Strobe(uint8_t state)
{
    CC25_CSN_off;
    SPI_Write(state);
    CC25_CSN_on;
}

void CC2500_WriteRegisterMulti(uint8_t address, const uint8_t data[], uint8_t length)
{
    CC25_CSN_off;
    SPI_Write(CC2500_WRITE_BURST | address);
    for(uint8_t i = 0; i < length; i++)
        SPI_Write(data[i]);
    CC25_CSN_on;
}

void CC2500_WriteData(uint8_t *dpbuffer, uint8_t len)
{
    CC2500_Strobe(CC2500_SFTX);
    CC2500_WriteRegisterMulti(CC2500_3F_TXFIFO, dpbuffer, len);
    CC2500_Strobe(CC2500_STX);
}

void CC2500_SetTxRxMode(uint8_t mode)
{
    if(mode == TX_EN) {
        //from deviation firmware
        CC2500_WriteReg(CC2500_00_IOCFG2, 0x2F);
        CC2500_WriteReg(CC2500_02_IOCFG0, 0x2F | 0x40);
    } else {
        if (mode == RX_EN) {
            CC2500_WriteReg(CC2500_02_IOCFG0, 0x2F);
            CC2500_WriteReg(CC2500_00_IOCFG2, 0x2F | 0x40);
        } else {
            CC2500_WriteReg(CC2500_02_IOCFG0, 0x2F);
            CC2500_WriteReg(CC2500_00_IOCFG2, 0x2F);
        }
    }
}
uint8_t CC2500_Reset()
{
    CC2500_Strobe(CC2500_SRES);
    delay(1);
    CC2500_SetTxRxMode(TXRX_OFF);
    return CC2500_ReadReg(CC2500_0E_FREQ1) == 0xC4;//check if reset
}
void CC2500_SetPower()
{
    uint8_t power=CC2500_BIND_POWER;
    if(IS_BIND_DONE)
        #ifdef CC2500_ENABLE_LOW_POWER
            power=IS_POWER_FLAG_on?CC2500_HIGH_POWER:CC2500_LOW_POWER;
        #else
            power=CC2500_HIGH_POWER;
        #endif
    if(IS_RANGE_FLAG_on)
        power=CC2500_RANGE_POWER;
    if(prev_power != power)
    {
        CC2500_WriteReg(CC2500_3E_PATABLE, power);
        prev_power=power;
    }
}