Code clean up and handling FIFO errors

Revision:
25:b278a215cf3b
Child:
31:8ab5d9a29a9f
Binary file README.txt has changed