Improved Menu

Improves menu printing to lcd display and input.
Merge branch 'master' of https://github.com/Droid5x/Lab4