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

#define LED_CHANNEL 1
#define SW_CHANNEL  2

void init_gpio();
u32 readsw();
void writeled(u32 value);

XGpio gpio;

int main()
{
	init_gpio();

	while (1)
	{
		writeled(readsw());
	}

	return 0;
}

//Initialize the GPIO pins for the LEDs and switches
void init_gpio()
{
	XGpio_Initialize(&gpio, XPAR_AXI_GPIO_0_DEVICE_ID);
}

//read the switches
u32 readsw()
{
	u32 val = 0;

	val = XGpio_DiscreteRead(&gpio, SW_CHANNEL);

	return val;
}

//Write val to the LEDs
void writeled(u32 value)
{
	u32 mask;

	mask = XGpio_DiscreteRead(&gpio, LED_CHANNEL);

	XGpio_DiscreteWrite(&gpio, 1, value | mask);
}