Split flush into three parts
Remove direct flush when header is written
Removed timing analysis code
Merge pull request #42 from crwper/fix_overflow

Fix UART overflow and timing issues