Moved initialisation calls to separate function.
WIP: get data from FIFO.