Sorted out battery processing and added checks to telemetry before updating
Fixed pitch/roll/yaw comparison was not treating floats as floats
Corrected debug message