-removed SERVO_HZ. should have deleted it long time ago! Lol
-explicitly added PERIODIC_FREQUENCY
-changed ins type to hff
-added AHRS_PROPAGATE_FREQUENCY, test this plz