#include "project.h"


static int led = 0;

void
led_init (void)
{
  gpio_set_mode (GPIOB, GPIO_MODE_OUTPUT_2_MHZ,
                 GPIO_CNF_OUTPUT_PUSHPULL, LED0);
  gpio_set_mode (GPIOB, GPIO_MODE_OUTPUT_2_MHZ,
                 GPIO_CNF_OUTPUT_PUSHPULL, LED1);
}


void
led_clear (void)
{
  gpio_set (GPIOB, LED0);
  gpio_set (GPIOB, LED1);
}

void
led_flash (uint32_t v)
{
  gpio_clear (GPIOB, v);
  led = 200;
}

void led_set(uint32_t v)
{
v&= LED_MASK;
gpio_clear(GPIOB,v);
v^=LED_MASK;
gpio_set(GPIOB,v);
}


void
led_tick (void)
{
  if (led)
    {
      led--;
      if (!led)
        led_clear ();
    }
}