Solve the bug https://github.com/fboris/QuadrotorFlightControl/issues/39 more properly
I think the problem we encountered is not the delay issue. Because we read the value which was not initialized, this issue might cause the problem. I let the statusReport_task suspend at startup. After system have done correction, statusReport_task will resume.