Use timer interrupt to ensure the flight control excute frequence is about 4,000hz (Not being flight test yet)