live pid graphs, don't adjust pid when idling
disable slow barometer, insert some simple PID values, add z stabilization
battery voltage read
high speed barometer code, remove ineffective z-compensation