Bugfix and cleanup of MINDSENSORS-AbsoluteIMU example

I fixed some bugs and cleaned up the test example code.