Nuttx merge 5554

After two hours of continuos sensor tests, pretty confident that this can be merged. Will continue to let it run throughout the day and report back.

The tests all command also reliably succeeds.