off by one bug caused FW readings to be out of order

[lkunelk]

• [ ] Only the minimal change is included in this PR the commits are kept minimal
• [ ] Code is readable and documented in the code
• [ ] Minimal tests have been added