Use timer interrupt to ensure the flight control excute frequence is about 4,000hz