TreelLab/prog/sources/setup-loop.cpp

#include "all-headers.h"

uint32_t antiBlinkBuffer;

DigitalPort LED[5];

void setup (USER_MODE) {
	// Start
	digitalWrite(L0_LED, true);

	antiBlinkBuffer = 0;

	LED[0] = L0_LED;
	LED[1] = L1_LED;
	LED[2] = L2_LED;
	LED[3] = L3_LED;
	LED[4] = L4_LED;
}

void loop (USER_MODE) {
	// Wait
	busyWaitDuring(MODE_ 500);

	antiBlinkBuffer <<= 1;
	antiBlinkBuffer |= 0x01;

	// Display anti blink buffer
	uint32_t bitSelector(1);
	for (uint32_t i(0); i < 5; i++) {
		digitalWrite(LED[i], antiBlinkBuffer & bitSelector);
		bitSelector <<= 1;
	}

	// Command leds with buttons
	if ( !digitalRead(P0_PUSH_BUTTON) )
		antiBlinkBuffer = 0;
}