Optimized register and port access a bit
Added serial character get functions

Added Echo test to app. Now you can open a terminal with:

    screen /dev/<your serial port> 19200

And see the characters you type echoed.
Fixed a build error