Proper proper yaw

Yaw is compensated for heavy fly bar
yaw input is filtered
Proper (and filtered) battery voltage reading