i2c data rate = 100 hz
preliminary altitude finish - roll , pitch ok but yaw is bad