Barometer code working!
PID Controllers still untested.
Things to do:
	Rewrite the veritical acceleration PID to be vertical velocity
	Collect more samples and average to determine initial altitude
	More Stuffs