TradHeli: Fix bugs in PiroComp

Successful bench test, ready for first test flight