Add correction task, seperate correction and flight control
Fix a bug in task handler initialization
Change task calling order

check_status->correction_task->flight_control_task

WARNING:It still have problem in scheduling
Unify coding style
Change memory management strategy to heap_2

FreeRTOS assertion suggest we use heap_2~4 instead heap_1
Delete the task by itself if that task is not the infinity loop