Use function "taskYIELD()" replace "vTaskDelay()"
Merge https://github.com/Khan-drone/ahrs-core
Use function "taskYIELD()" replace "vTaskDelay()"