Hinfinity controller for INDI guidance outer loop

guidance_indi