fix(bhi160): Fix FIFO parsing algorithm

FIFO parsing would parse certain packets late because of an incorrect
assumption about FIFO-internals.

Signed-off-by: Rahix <rahix@rahix.de>