Possible LCD Fix

Started Implementing better LCD Driver which reads data from LCD but
Init function does not make use of this yet

Changed the Init Function slightly, this seems to fix the corruption of
Reset Issue. This issue appears to happed when calling lcd_init() twice
without removing power to the PCB.