Refactored LCDInit
LCD library cleanup
Refactoring and cleanup