Tests and simplification for ImuDeadReckoning#422

brickbots wants to merge 4 commits into

mainbrickbots/PiFinder:mainfrom

idr_testsbrickbots/PiFinder:idr_testsCopy head branch name to clipboard