Improved display driver, added demo

Improved display driver, added pixel, line and rectangle drawing. Added
mutli color mode to the driver.
Added demo graphics.
Cleaned up code.