TECS : improved height complementary filter gain allocation