diff --git a/Inc/FreeRTOSConfig.h b/Inc/FreeRTOSConfig.h
index 6fc7f70..a5648f3 100644
--- a/Inc/FreeRTOSConfig.h
+++ b/Inc/FreeRTOSConfig.h
@@ -68,7 +68,7 @@
 #define configTICK_RATE_HZ                       ((TickType_t)1000)
 #define configMAX_PRIORITIES                     ( 7 )
 #define configMINIMAL_STACK_SIZE                 ((uint16_t)512)
-#define configTOTAL_HEAP_SIZE                    ((size_t)60000)
+#define configTOTAL_HEAP_SIZE                    ((size_t)85000)
 #define configMAX_TASK_NAME_LEN                  ( 16 )
 #define configGENERATE_RUN_TIME_STATS            1
 #define configUSE_TRACE_FACILITY                 1