Fixed a bug in the altimeter library, tweaked IMU DMP example