Debugging attitude controller RPM vs Thrust calculations