Updated firmware

Some updates done:
- Moved strings to ROM
- Added comments
- Added some debugging code
- Now debug mode off by defaulr