Merge pull request #1144 from skidau/fifo-linked Moved the linking of the FIFO CPWritePointer near where CPWritePointer gets updated