Copied the OLED lib example from the reference manual. Not tested.