#include "xparameters.h"
#include "xgpio.h"
#include "sleep.h"

//====================================================

int main (void) 
{

    XGpio dip, push, leds;
	int psb_check, dip_check, led_out;
	
    xil_printf("-- Start of the Program --\r\n");
 
    XGpio_Initialize(&dip, XPAR_SWITCHES_DEVICE_ID);
	XGpio_SetDataDirection(&dip, 1, 0xffffffff);
	
	XGpio_Initialize(&push, XPAR_BUTTONS_DEVICE_ID);
	XGpio_SetDataDirection(&push, 1, 0xffffffff);
	
	XGpio_Initialize(&leds, XPAR_LEDS_DEVICE_ID);
	XGpio_SetDataDirection(&leds, 1, 0x00000000);
	
	while (1)
	{
	  psb_check = XGpio_DiscreteRead(&push, 1);
	  xil_printf("Push Buttons Status %x\r\n", psb_check);
	  dip_check = XGpio_DiscreteRead(&dip, 1);
	  xil_printf("DIP Switch Status %x\r\n", dip_check);
	  led_out = 0x00000000;
	  led_out = (dip_check << 4) | psb_check;
	  XGpio_DiscreteWrite(&leds,1,led_out);
	  xil_printf("Leds updated \r\n");
	  sleep(1);
	}
 
}