Change roll_pitch_init condition & Throttle assist

Throttle assist available in STABILIZE MODE with CH7 enabled