#include <stdio.h>
#include "platform.h"
#include "XIOModule.h"

#define IOBUS_write_fifo       (*(volatile u32 *) 0xC0000000)

XIOModule DelayTimer;

void delay_us(u32 time);

void myISR( void )
{
        IOBUS_write_fifo = 0xA;
        delay_us(1);
        IOBUS_write_fifo = 0xB;
}

int main()
{
    init_platform();

    u32 uGpi0;
    //external interrupt
    u8  uIntrId = 16;//XPAR_IOMODULE_0_SYSTEM_INTC_INTERRUPT_0_INTR;

    XIOModule NfdsIOMdule;

    XIOModule_Initialize(&NfdsIOMdule, XPAR_IOMODULE_0_DEVICE_ID);
    XIOModule_Start(&NfdsIOMdule);

    // Initialize the Timer
    u32 status;
    status = XIOModule_Timer_Initialize(&DelayTimer, XPAR_IOMODULE_0_DEVICE_ID);
    if (status != XST_SUCCESS){
        xil_printf("Timer failed to initialize\r\n");
        return XST_FAILURE;
    }

    XIOModule_Timer_SetOptions(&DelayTimer, 0, XTC_INT_MODE_OPTION);

    microblaze_register_handler(XIOModule_DeviceInterruptHandler, XPAR_IOMODULE_0_DEVICE_ID);
    XIOModule_Connect(&NfdsIOMdule, uIntrId, myISR, XPAR_IOMODULE_0_DEVICE_ID);
    XIOModule_Enable(&NfdsIOMdule, uIntrId);

    microblaze_enable_interrupts();

    while(1)
    {
        uGpi0 = XIOModule_DiscreteRead(&NfdsIOMdule, 1); //read gpio (Slide Switches)
        XIOModule_DiscreteWrite(&NfdsIOMdule, 1, uGpi0); //write gpio (Discrete LEDs)
    }

    cleanup_platform();

    return 0;
}

void delay_us(u32 time)
{
    XIOModule_SetResetValue(&DelayTimer, 0, time);
    XIOModule_Timer_Start(&DelayTimer, 0);
    while(!(XIOModule_IsExpired(&DelayTimer, 0))){}
    XIOModule_Timer_Stop(&DelayTimer, 0);
}

static XTmrCtr _TimerCounter; //структура настройки Таймера
XTmrCtr *TimerCounter = &(_TimerCounter); //указатель для удобства использования функций

//Инициализируем таймер
InitStatus = XTmrCtr_Initialize(TimerCounter, XPAR_ETHERNET_TIMER_DEVICE_ID);

//если устройство запущено, его надо установить и заново запустить инициализацию
if(InitStatus == XST_DEVICE_IS_STARTED)
{
print("\r\nРучная остановка таймера");
//надо получить данные настройки таймера вручную
XTmrCtr_Config *TmrCtrConfigPtr;
TmrCtrConfigPtr = XTmrCtr_LookupConfig(XPAR_ETHERNET_TIMER_DEVICE_ID);
if(TmrCtrConfigPtr!=NULL)
{
print("\r\nПолучение структуры таймера");
//заполняем настройки
TimerCounter->BaseAddress = TmrCtrConfigPtr->BaseAddress;
TimerCounter->IsReady = XIL_COMPONENT_IS_READY;
XTmrCtr_Stop(TimerCounter,0); //останавливаем 0 канал
XTmrCtr_Stop(TimerCounter,1); //останавливаем 1 канал
}
//сбрасываем настройки
TimerCounter->BaseAddress = 0;
TimerCounter->IsReady = 0;

print("\r\nПовторная инициализация таймера");
//инициализируем заново
InitStatus = XTmrCtr_Initialize(TimerCounter, XPAR_ETHERNET_TIMER_DEVICE_ID);
}

if(InitStatus != XST_SUCCESS)
xil_printf("\r\nОшибка инициализации таймера: %d",InitStatus);
else
{
InitStatus = XTmrCtr_SelfTest(TimerCounter, 0);
if(InitStatus != XST_SUCCESS)
xil_printf("\r\nОшибка самотестирования таймера: %d",InitStatus);
else
print("\r\nТаймер: OK!");


//настраиваем самоперезагрузку 0 таймера, и включаем прерывание
XTmrCtr_SetOptions(TimerCounter, 0, XTC_AUTO_RELOAD_OPTION|XTC_INT_MODE_OPTION);

//настраиваем самоперезагрузку 1 таймера, и включаем прерывание
XTmrCtr_SetOptions(TimerCounter, 1, XTC_AUTO_RELOAD_OPTION|XTC_INT_MODE_OPTION);


//задаим начальное значение таким, это время до прерывания
//0 канал
XTmrCtr_SetResetValue(TimerCounter, 0, TIMER_250MS_INTERVAL); //250 мСек
//XTmrCtr_SetResetValue(TimerCounter, 0, TIMER_10MS_INTERVAL); //10 мСек

//1 канал
XTmrCtr_SetResetValue(TimerCounter, 1, TIMER_500MS_INTERVAL); //500 мСек

//подключаем обработчик прерывания
XTmrCtr_SetHandler(TimerCounter,(XTmrCtr_Handler)InterruptHandler_Timer,(void *)TimerCounter);
}