+static void blink(uint8_t which, uint8_t count) {
+ uint8_t i;
+ for (i = 0; i < count; i++) {
+ if (i) Hal_delay(50);
+ if (which & 1) Hal_greenLedOn();
+ if (which & 2) Hal_redLedOn();
+ Hal_delay(50);
+ if (which & 1) Hal_greenLedOff();
+ if (which & 2) Hal_redLedOff();
+ }
+}
+