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

XGpioPs led;
XGpioPs_Config *led_config;

void init(){

	int status;
	led_config = XGpioPs_LookupConfig(XPAR_PS7_GPIO_0_DEVICE_ID);
	status = XGpioPs_CfgInitialize(&led, led_config, led_config->BaseAddr);
	if(status == XST_SUCCESS)
		xil_printf("Device init Successful\n");
	else
		xil_printf("Device Init Failed\n");


}

int main()
{
    init_platform();
    init();

    XGpioPs_SetDirectionPin(&led, 54, 1);
    XGpioPs_SetOutputEnablePin(&led, 54, 1);

    XGpioPs_SetDirectionPin(&led, 55, 1);
    XGpioPs_SetOutputEnablePin(&led, 55, 1);

    XGpioPs_SetDirectionPin(&led, 56, 1);
    XGpioPs_SetOutputEnablePin(&led, 56, 1);

    XGpioPs_SetDirectionPin(&led, 57, 1);
    XGpioPs_SetOutputEnablePin(&led, 57, 1);

    while(1)
    {
    	XGpioPs_WritePin(&led, 54, 1);
    	XGpioPs_WritePin(&led, 55, 1);
    	XGpioPs_WritePin(&led, 56, 1);
    	XGpioPs_WritePin(&led, 57, 1);

    	sleep(1);

    	XGpioPs_WritePin(&led, 54, 0);
    	XGpioPs_WritePin(&led, 55, 0);
    	XGpioPs_WritePin(&led, 56, 0);
    	XGpioPs_WritePin(&led, 57, 0);

    	sleep(1);



    }



    cleanup_platform();
    return 0;
}