More efficient timer link, added sqrt to arith, control.c is now Non linear complementary filter (nlcf.c)