Added code to read raw data from the onboard barometer, changed stabilization code.