#include "board.h"
#include "myRadio.h"
#include "myRadio_gpio.h"

/**-------------------------radio include----------------------------------**/
#include "PAN312x_Driver.h"
/**-------------------------radio include end----------------------------------**/

static int8_t rfTxPower;
static uint32_t rfFrequence;
static uint32_t rfBaudrate;
static uint8_t rfSyncword;
static rfRxCallBack rxCb;
static uint8_t rfRxBuffer[255];
static uint32_t rf_handle;
static uint8_t rf_workProcess = RF_PRC_IDLE;
static uint8_t chipType;
/**-------------------------radio params----------------------------------**/
#define CRC_ENABLE
PAN312xRadioInit RadioInit = {
	.FrequencyBase          = 433920000,
	.FrequencyStep          = 0,
	.FrequencyChannelNumber = 0,
	.ModulationSelect       = MOD_2FSK,
	.DataRate               = 10000,   /* match Simple_PingPong */
	.TxDeviation            = 5000,   /* match Simple_PingPong */
	.RxDeviation            = 5000,   /* match Simple_PingPong */
	.PowerSelect            = POWER_LDO_0603,      //POWER_LDO_0603,
    .Power                  = POWER_20dBm,        //LDO模式，功率最大20dBm
};

PAN312xCrcInit CrcInit = {
	.CrcMode       = CRC_MODE_16_BIT,
	.CrcPolynomial = 0x8005,
	.CrcSeed       = 0xffff,
	.CrcBitOrder   = CRC_BIT_ORDER_MSB_FIRST,
	.CrcByteSwap   = CRC_BYTE_MSB_FIRST,
	.CrcRange      = CRC_RANGE_WHOLE_PAYLOAD,
	.CrcBitInv     = S_DISABLE,
    .CrcState      = S_ENABLE,
};

PAN312xPacketInit PacketInit = {
	.PacketType                 = VARIABLE_PACKET_TYPE,
	.PreambleLength             = 8,
	.PreambleSeclect            = PREAMBLE_0101,
	.NonStandardPreamblePattern = 0,				
	.SyncwordLength             = 4,
	.SyncwordPattern            = 0x2dd42dd4,
	.PreambleManchesterMode     = MANCHESTER_ZeroToTwo,
	.PreambleManchester         = S_DISABLE,
	.SyncwordManchesterMode     = MANCHESTER_ZeroToTwo,
	.SyncwordManchester         = S_DISABLE,
	.PayloadManchesterMode      = MANCHESTER_ZeroToTwo,
	.PayloadManchester          = S_DISABLE,
	.FecEncoding                = FEC_HAMING_DISABLE,
	.WhiteningPattern           = WHITENING_DISABLE,
	.DataMode                   = DATA_MODE_PACKET,
    .PayloadBitOrder            = PAYLOAD_BIT_ORDER_MSB_FIRST,
};


typedef struct 
{
    uint32_t DataRate;
	uint32_t TxDeviation;
	uint32_t RxDeviation;
}rdModuleParams_ts;

rdModuleParams_ts rdDeviationParams[] = {
    {2400, 1200, 1200},       // 2.4kbps
    {10000, 5000, 5000},       // 10kbps
    {50000, 25000, 25000},     // 50kbps
    {100000, 50000, 50000},     // 100kbps
    {200000, 100000, 100000},   // 200kbps
    {500000, 250000, 250000},   // 500kbps
};
uint8_t powerValueList[] = {
    POWER_20dBm,POWER_19dBm,POWER_18dBm,POWER_17dBm,POWER_16dBm,POWER_15dBm,POWER_14dBm,POWER_13dBm,POWER_12dBm,POWER_11dBm,POWER_10dBm,POWER_9dBm,POWER_8dBm,POWER_7dBm,POWER_6dBm,POWER_5dBm,POWER_4dBm,POWER_3dBm,POWER_2dBm,POWER_1dBm,POWER_0dBm,POWER_N1dBm,POWER_N2dBm,POWER_N3dBm,POWER_N4dBm,POWER_N5dBm,POWER_N6dBm,POWER_N7dBm,POWER_N8dBm,POWER_N9dBm,POWER_N10dBm,POWER_N11dBm,POWER_N12dBm,POWER_N13dBm,POWER_N14dBm,POWER_N15dBm,POWER_N16dBm,POWER_N17dBm,POWER_N18dBm,POWER_N19dBm,POWER_N20dBm
};
bool rf_ifq;

uint8_t getRfPowerTabIndex(int8_t power);
/**-------------------------radio params end----------------------------------**/
void myRadio_delay(uint32_t time_ms)
{
    delay1ms(time_ms);
}
/**
 * @brief IO口中断回调
 *      IO口产生中断后会执行该函数
 *      用于接收射频工作的中断响应
 * 
 * @param index 
 */
void myRadio_gpioCallback(uint8_t index)
{
    rf_ifq = true;
}
/**
 * @brief 射频初始化
 * 
 * @param agr0 
 * @param agr1_ptr 无线工作状态响应回调
 *          产生回调给外部使用，@rfRxCallBack
 */
void myRadio_init(int agr0, void *agr1_ptr)
{
    myRadio_gpio_init(myRadio_gpioCallback);
/**-------------------------radio init----------------------------------**/

    PAN312x_DIO8_INTDISABLE();
    
    PAN312x_Fsk_Init();
    
    uint16_t fwid_buf=0;
    PAN312x_Get_FwId(&fwid_buf);
    if (fwid_buf == 0x00)
    {
        return;
    }
    
    PAN312x_RadioInit(&RadioInit);
    PAN312x_PktInit(&PacketInit);
    PAN312x_CrcInit(&CrcInit);
    
	if (PacketInit.PacketType == FIXED_PACKET_TYPE)
    {
        if(CrcInit.CrcState == S_ENABLE){
            PAN312x_Set_TxPacket_Config(TxFixedPackedCrcEnable);
            PAN312x_Set_RxPacket_Config(RxFixedPackedCrcEnable);
        }else if(CrcInit.CrcState == S_DISABLE){
            PAN312x_Set_TxPacket_Config(TxFixedPackedCrcDisable);
            PAN312x_Set_RxPacket_Config(RxFixedPackedCrcDisable);
        }
    }
    else
    {
        if(RadioInit.PowerSelect == POWER_DCDC_0402 || RadioInit.PowerSelect == POWER_DCDC_0603){
            PAN312x_DCDC_Enable();
        }
        
        if(CrcInit.CrcState == S_ENABLE){
            if(CrcInit.CrcBitInv == S_DISABLE){
                PAN312x_Set_RxPacket_Config(RxVariablePackedCrcEnable);
                PAN312x_Set_TxPacket_Config(TxVariablePackedCrcEnable);
            }else if(CrcInit.CrcBitInv == S_ENABLE){
                PAN312x_Set_RxPacket_Config(RxVariablePackedCrcBitInvCrcEnable);
            }
        }else if(CrcInit.CrcState == S_DISABLE){
            PAN312x_Set_RxPacket_Config(RxVariablePackedCrcDisable);
            PAN312x_Set_TxPacket_Config(TxVariablePackedCrcDisable);
        }
    }
    
    PAN312x_GpioIrq_Config((PAN312xIrqList)(IRQ_MASK_TX_DONE | IRQ_MASK_RX_DONE | IRQ_MASK_RX_CRC_ERROR | IRQ_MASK_RX_TIMEOUT), S_ENABLE);
	PAN312x_System_Ctrl(SYS_CTRL_AUTO_CLEAR_STATUS);
	
    PAN312x_Irq_Clear_AllStatus();
    
    PAN312x_Set_RxTimeout_ExitState(STATE_READY);
    PAN312x_Set_RxInvalid_ExitState(STATE_READY);
    PAN312x_Set_RxValid_ExitState(STATE_READY);
    DIO8_EnableInterrupt();
    
    #if 0//cw test
    
    PAN312x_Enter_Carrier(433920000,POWER_21dBm);
    while(1);
    
    #endif
    
    #if 0  //sleep test 
    
    PAN312x_Enter_Sleep(DEEP_SLEEP_MODE, WAKE_UP_STATE_READY);
    GPIO_SLEEP_state();//把所有与模块相接的IO口设置为模拟端口
    
    delay1ms(3000);//RF休眠3S后重新进入工作状态
    
    board_GpioInit();
    board_spi_int();
    
    
    PAN312x_DIO8_INTDISABLE();
    PAN312x_Fsk_Init();
    PAN312x_RadioInit(&RadioInit);
    PAN312x_PktInit(&PacketInit);
    PAN312x_CrcInit(&CrcInit);
    DIO8_EnableInterrupt();
    
    #endif
    
/**-------------------------radio init end----------------------------------**/
    myRadio_delay(10);
    if ((rfRxCallBack )agr1_ptr)
    {
        rxCb = (rfRxCallBack )agr1_ptr;
    }
    rf_handle = 0xe5;
}
/**
 * @brief 射频底层执行程序
 *      要放在主循环中执行
 * 
 */
void myRadio_process(void)
{
    rfRxPacket_ts rfRxPacket;
    PAN312xIrqs xIrqStatus;
    if (rf_handle == 0)
    {
        return;
    }
    if (rf_ifq == false)
    {
        return;
    }
    rf_ifq = false;
    if (!((rf_workProcess == RF_PRC_TX) || (rf_workProcess == RF_PRC_RX)))
    {
        return;
    }
    PAN312x_Irq_Get_Status(&xIrqStatus);
    printf("xIrqStatus.IRQ_STATUS0_F=%02X\n", xIrqStatus.IRQ_STATUS0_F);
    if(xIrqStatus.IRQ_STATUS0_F.IRQ_TX_DONE)
    {        
        PAN312x_Enter_Ready();
        PAN312x_Flush_TxFifo();
        PAN312x_Irq_Clear_AllStatus();
        PAN312x_Reset_Modem();
        if (rxCb)
        {
            rxCb(TX_STA_SECCESS, rfRxPacket);
        }
    }
    
    if(xIrqStatus.IRQ_STATUS0_F.IRQ_RX_DONE)
    {  
        if (rxCb)
        {      
            // PAN312x_GetRSSI返回的是绝对值
            rfRxPacket.rssi = -(PAN312x_GetRSSI());
            
            rfRxPacket.len = PAN312x_Get_RxLengthInFifo();
            PAN312x_Read_Fifo(rfRxPacket.payload, rfRxPacket.len);
            printf("rssi=%d len=%d payload=<%s> ", rfRxPacket.rssi, rfRxPacket.len, rfRxPacket.payload);
            PAN312x_Irq_Clear_RxDone_Status();
            PAN312x_Enter_Ready();
            rxCb(RX_STA_SECCESS, rfRxPacket);
        }
        
    }
    
    if(xIrqStatus.IRQ_STATUS0_F.IRQ_RX_CRC_ERROR || 
        xIrqStatus.IRQ_STATUS0_F.IRQ_RX_COMPLETE || 
        xIrqStatus.IRQ_STATUS0_F.IRQ_RX_NODEID_ERROR || 
        xIrqStatus.IRQ_STATUS0_F.IRQ_RX_LENGTH_DONE || 
        xIrqStatus.IRQ_STATUS0_F.IRQ_RX_NODEID_DONE)
    {
        printf("xIrqStatus.IRQ_STATUS0_F=%02X\n", xIrqStatus.IRQ_STATUS0_F);
        PAN312x_Irq_Clear_RxCrcError_Status();
        PAN312x_Enter_Ready();
        if (rxCb)
        {
            rxCb(RX_STA_PAYLOAD_ERROR, rfRxPacket);
        }
    }
}
/**
 * @brief 退出射频进入休眠
 * 
 */
void myRadio_abort(void)
{
    if (rf_handle == 0)
    {
        return;
    }
    PAN312x_Enter_Sleep(SLEEP_MODE, WAKE_UP_STATE_READY);
    rf_workProcess = RF_PRC_SLEEP;
}
/**
 * @brief 获取射频工作中心频率
 * 
 * @return uint32_t 
 */
uint32_t myRadio_getFrequency(void)
{
    if (rf_handle == 0)
    {
        return 0;
    }
    return RadioInit.FrequencyBase + RadioInit.FrequencyChannelNumber * RadioInit.FrequencyStep;
}
/**
 * @brief 设置射频工作中心频率对应的信道
 * 
 * @param freq 
 *      单位：
 */
void myRadio_setFrequency(uint32_t freq)
{
    if (rf_handle == 0)
    {
        return;
    }
    RadioInit.FrequencyBase = freq;
    PAN312x_RadioInit(&RadioInit);
}
/**
 * @brief 获取发射功率
 * 
 * @return int8_t 
 */
int8_t myRadio_getTxPower(void)
{
    if (rf_handle == 0)
    {
        return 0;
    }
    return rfTxPower;
}
/**
 * @brief 设置发射功率等级
 * 
 * @param power 
 *          单位：
 */
void myRadio_setTxPower(int8_t power)
{
    if (rf_handle == 0)
    {
        return;
    }
    rfTxPower = power;
    RadioInit.Power = powerValueList[rfTxPower];
    PAN312x_RadioInit(&RadioInit);
}
/**
 * 获取射频波特率
 * @param : br->
*/
uint32_t myRadio_getBaudrate(void)
{
    if (rf_handle == 0)
    {
        return 0;
    }
    return rdDeviationParams[rfBaudrate].DataRate;
}
/**
 * 设置射频波特率序号
 * @param : br->
*/
void myRadio_setBaudrate(uint32_t br)
{
    if (rf_handle == 0)
    {
        return;
    }
    rfBaudrate = br;

    RadioInit.DataRate = rdDeviationParams[rfBaudrate].DataRate;
    RadioInit.TxDeviation = rdDeviationParams[rfBaudrate].TxDeviation;
    RadioInit.RxDeviation = rdDeviationParams[rfBaudrate].RxDeviation;
    PAN312x_RadioInit(&RadioInit);
}
void myRadio_setSyncWord(uint8_t syncword)
{
    if (rf_handle == 0)
    {
        return;
    }
    rfSyncword = syncword;
}
void myRadio_setRfParams(uint8_t sf, uint8_t bw, uint8_t cr)
{
    if (rf_handle == 0)
    {
        return;
    }
}
/**
 * @brief 设置模组型号
 * 
 * @param type 
 */
void myRadio_setChipType(uint8_t type)
{
    chipType = type;
}
/**
 * @brief 获取模组型号
 * 
 * @return uint8_t 
 */
uint8_t myRadio_getChipType(void)
{
    return chipType;
}
int16_t myRadio_getRssi(void)
{
    return (int16_t)0;
}
/**
 * @brief 无线发送数据包
 * 
 * @param packet 
 */
void myRadio_transmit(rfTxPacket_ts *packet)
{
    if (rf_handle == 0)
    {
        return;
    }
    if (rf_workProcess == RF_PRC_SLEEP)
    {
        PAN312x_ClkRcl_Enable();
        PAN312x_WakeUp_BySpi();
        myRadio_delay(10);
    }
    
    PAN312x_Enter_Ready();
    PAN312x_Irq_Clear_AllStatus();
    PAN312x_Write_Fifo(packet->payload, packet->len);

    if(PAN312x_OK != PAN312x_Enter_Tx(0, 0, packet->len)){
        // g_nNextRFState = RF_STATE_ERROR;
    }else{
        // g_nNextRFState = RF_STATE_TX_WAIT;
    }
    
    rf_workProcess = RF_PRC_TX;
}
/**
 * @brief 进入无线接收
 * 
 */
void myRadio_receiver(void)
{ 
    if (rf_handle == 0)
    {
        return;
    }
    if (rf_workProcess == RF_PRC_SLEEP)
    {
        PAN312x_ClkRcl_Enable();
        PAN312x_WakeUp_BySpi();
        myRadio_delay(10);
    }
    PAN312x_Enter_Ready();
    PAN312x_Irq_Clear_AllStatus();
    
    PAN312x_Flush_RxFifo();
    
    if(PAN312x_OK != PAN312x_Enter_Rx(0, 0, 0)){
        // g_nNextRFState = RF_STATE_ERROR;
    }else{
        // g_nNextRFState = RF_STATE_RX_WAIT;
    }
    rf_workProcess = RF_PRC_RX;
}
void myRadio_setCtrl(controlMode_te mode, uint32_t value)
{
    if (rf_handle == 0)
    {
        return;
    }
    rf_workProcess = RF_PRC_TEST_TX;
    switch (mode)
    {
    case RADIO_EXT_CONTROL_TX_UNMODULATED:
    {
        myRadio_init(0, 0);

        rf_workProcess = RF_PRC_TEST_TX;
        PAN312x_Enter_Carrier(RadioInit.FrequencyBase, RadioInit.FrequencyStep, RadioInit.FrequencyChannelNumber, POWER_LDO_0402, RadioInit.Power);
    }
        break;
    case RADIO_EXT_CONTROL_TX_MODULATED:
    {
        rf_workProcess = RF_PRC_TEST_TX;
    }
        break;
    case RADIO_EXT_CONTROL_RX_SENSITIVITY:
    {
        myRadio_init(0, 0);    
        /*
        * GPIO1 ----> DirectRx
        * GPIO2 ----> DirectClk
        */

        PAN312x_Iomux_Gpio(IOMUX_GPIO0_AS_DIRECT_RX);
        PAN312x_Set_Gpio_Mode(PAN312x_GPIO_PIN_0, GPIO_OUTPUT_MODE);
        
        PAN312x_Iomux_Gpio(IOMUX_GPIO2_AS_DIRECT_CLK);
        PAN312x_Set_Gpio_Mode(PAN312x_GPIO_PIN_2, GPIO_OUTPUT_MODE);
        
        //使能GPIO Direct Rx
        PAN312x_GPIO_Direct_Rx_Enable();
        
        //GPIO Direct Rx寄存器初始化
        PAN312x_Gpio_Direct_Rx_Regmap_Init();
        
        //配置为同步模式
        PAN312x_Gpio_Direct_Synchronous_Mode();
        
        PAN312x_Gpio_Direct_RxByPass_Enable();
        
        

        PAN312x_Enter_Rx(0, 0, 0);
        rf_workProcess = RF_PRC_RX;
    }
        break;
    
    default:
        break;
    }
}

/**-------------------------radio funtion end----------------------------------**/