flexavr/led.ino at master · daveake/flexavr · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
unsigned long NextLEDs=0;

void SetupLEDs(void)
{
  pinMode(LED_WARN, OUTPUT);
  digitalWrite(LED_WARN, 1);

  pinMode(LED_OK, OUTPUT);
  digitalWrite(LED_OK, 0);
}

void ControlLEDs(int LEDOK, int LEDWarn)
{
  digitalWrite(LED_OK, LEDOK);

  digitalWrite(LED_WARN, LEDWarn);
}

void CheckLEDs(void)
{
  if (millis() >= NextLEDs)
  {
    static byte Flash=0;

    // This would normally be the only LED for status (i.e. no OK or WARN LEDs)
    if (GPS.Altitude > 1000)
    {
      // All off
      ControlLEDs(0,0);
    }
    else if ((GPS.FixType == 3) && (GPS.Satellites >= 4))
    {
      ControlLEDs(Flash, 0);
    }
    else
    {
      ControlLEDs(0, Flash);
    }

    NextLEDs = millis() + 500L;
    Flash = 1-Flash;
  }
}