#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()
{

	u32 btnData = 0;
    init_platform();
    init();
    XGpioPs_SetDirectionPin(&led, 7, 1);
    XGpioPs_SetOutputEnablePin(&led, 7, 1);

    XGpioPs_SetDirectionPin(&led, 50, 0);

    xil_printf("Starting GPIO MIO LED TEST\n");

    while(1){

    	btnData = XGpioPs_ReadPin(&led, 50);
    	XGpioPs_WritePin(&led, 7, btnData);
    	xil_printf("Value read : %0d\n",btnData);
    	sleep(2);

    }



    cleanup_platform();
    return 0;
}