Working version of DMP code. Outputs stable rotation estimates according to axes in the chip's datasheet.