Added working LCD code and other minor tweaks
Added working LCD code and other various tweaks