http://mbed.org/users/aberk/code/ITG3200/#b098d99dd81e