Refactored FSMC lcd driver