Add full seven segment driver, function write7seg() to write a string.

Also removed old 7seg code from main.