New button handling + LCD update fix + code clean + Debug modified

Initial code for 2 button reading

LCD update fix, instead of updating the LCD every loop, update every
200ms, this has boosted the speed of the program and LCD display is not
affected. Program runs smoother and faster.
Added code for more variables
Code clean and debug printing clean
Code clean
Code clean
Added Menu capability
Code Clean
Code clean