Added Keypad Stuff

- Keypad now changes LCD using polling (might be changed to interrupt in
final version)
- NEED TO ADD MOTOR