/* Includes */
#include "stm32f4xx.h"
#include "stm32f4_discovery.h"
#include "FreeRTOS.h"
#include "task.h"
#include "semphr.h"

xSemaphoreHandle xBinarySemaphore;
xTaskHandle xBlinkLed;
xTaskHandle xBlinkLed1;

static void vBlinkLed1(void *pvParameters);
static void vEXTI0_IRQHandler(void *pvParameters);
static void vBlinkLed( void *pvParameters );

int main(void)
{

      /* Initialize LEDs */
      STM_EVAL_LEDInit(LED3);
      STM_EVAL_LEDInit(LED4);
      STM_EVAL_LEDInit(LED5);
      STM_EVAL_LEDInit(LED6);

      STM_EVAL_PBInit(BUTTON_USER, BUTTON_MODE_EXTI);

      vSemaphoreCreateBinary( xBinarySemaphore );
      xSemaphoreTake( xBinarySemaphore, portMAX_DELAY);

      if( xBinarySemaphore != NULL )
      {
          xTaskCreate( vBlinkLed, ( signed char * ) "vBlinkLed", configMINIMAL_STACK_SIZE, NULL, 4, &xBlinkLed );
          xTaskCreate( vEXTI0_IRQHandler, ( signed char * ) "vEXTI0_IRQHandler", configMINIMAL_STACK_SIZE, NULL, 4, NULL );
          vTaskStartScheduler();
      }
  return 0;
}

void vBlinkLed1(void *pvParameters) {
        unsigned short i = 0;
        struct smb380_acc_t acc;
        portTickType xLastWakeTime;
        xLastWakeTime = xTaskGetTickCount();
        for (;;) {
                STM_EVAL_LEDOn(LED3);
                vTaskDelayUntil( &xLastWakeTime, ( 100 / portTICK_RATE_MS ) );
                STM_EVAL_LEDOff(LED3);
        }
}

void vBlinkLed( void *pvParameters )
{
    for(;;)
    {
        STM_EVAL_LEDToggle(LED3);
        STM_EVAL_LEDToggle(LED4);
        STM_EVAL_LEDToggle(LED5);
        STM_EVAL_LEDToggle(LED6);
        vTaskDelay(1000 / portTICK_RATE_MS);
    }
}

void vEXTI0_IRQHandler( void *pvParameters )
{
    static int cr = 0;
    for ( ;; )
    {
        xSemaphoreTake( xBinarySemaphore, portMAX_DELAY );
        {
            STM_EVAL_LEDOff(LED3);
            STM_EVAL_LEDOff(LED4);
            STM_EVAL_LEDOff(LED5);
            STM_EVAL_LEDOff(LED6);
            if (cr == 0)
            {
                vTaskDelete(xBlinkLed);
                xTaskCreate( vBlinkLed1, ( signed char * ) "vBlinkLed1", configMINIMAL_STACK_SIZE, NULL, 4, &xBlinkLed1);
                cr = 1;
            }
            else
            {
                xTaskCreate( vBlinkLed, ( signed char * ) "vBlinkLed", configMINIMAL_STACK_SIZE, NULL, 4, &xBlinkLed );
                vTaskDelete(xBlinkLed1);
                cr = 0;
            }
        }
    }
}

void EXTI0_IRQHandler(void)
{
      if(EXTI_GetITStatus(EXTI_Line0) != RESET)
      {
          static portBASE_TYPE xHigherPriorityTaskWoken = pdFALSE;
          EXTI_ClearITPendingBit(EXTI_Line0);
          xHigherPriorityTaskWoken = pdFALSE;
          xSemaphoreGiveFromISR( xBinarySemaphore, &xHigherPriorityTaskWoken );
          portEND_SWITCHING_ISR(xHigherPriorityTaskWoken);
      }
}