1. change the reading period of test.cpp from 5s to 0.5s for better debugging
2. change the default telemetry infomation of quadcopter