#include <stdio.h>
#include "platform.h"
#include "xil_printf.h"
#include "xgpio.h"
#include "xparameters.h"

XGpio led, sw;

void gpio_init(){

	int statusl = XGpio_Initialize(&led, XPAR_LED_DEVICE_ID);
	int statuss = XGpio_Initialize(&sw, XPAR_SWITCH_DEVICE_ID);

	if((statusl & statuss) == XST_SUCCESS)
		xil_printf("Device Init Successful\n");
	else
		xil_printf("Device Init Failed\n");


}

int main()
{
	u32 swRead = 0;
    init_platform();
    gpio_init();

    XGpio_SetDataDirection(&sw, 1, 0xf);
    XGpio_SetDataDirection(&led, 1, 0x0);

    while(1){
    	swRead = XGpio_DiscreteRead(&sw, 1);
    	XGpio_DiscreteWrite(&led, 1, swRead);
    	xil_printf("Sw Read : %0d\n", swRead);
    	sleep(1);
    }




    cleanup_platform();
    return 0;
}