Test FIFO and HDMI (draw red, green or blue on screen) in main.c. Both tests currently work with an older version of the hardware code. Fix some logic in the HDMI test so that it can exit the loop.