MPU6000 driver improvements

These are driver improvements contributed by Andrew Tridgell that fix a corner case during init and add support to set the digital low-pass filter on-chip.