code refactor; better parameter tuning for my setup, for roll stabilization; disable yaw stabilization and yaw ESCs for now;