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>
2 jobs for !22 with rahix/bhi in 45 seconds (queued for 3 seconds)
merge request