diff --git a/flight/pios/common/libraries/FreeRTOS/Source/portable/MemMang/heap_1.c b/flight/pios/common/libraries/FreeRTOS/Source/portable/MemMang/heap_1.c
index eb47be24b..88154cf15 100644
--- a/flight/pios/common/libraries/FreeRTOS/Source/portable/MemMang/heap_1.c
+++ b/flight/pios/common/libraries/FreeRTOS/Source/portable/MemMang/heap_1.c
@@ -103,7 +103,7 @@ static uint8_t *pucAlignedHeap = NULL;
 size_t mask = alignment - 1;
 	/* Ensure that blocks are always aligned to the required number of bytes. */
 	#if portBYTE_ALIGNMENT != 1
-		if( xWantedSize & portBYTE_ALIGNMENT_MASK )
+		if( xWantedSize & mask )
 		{
 			/* Byte alignment required. */
 		    xWantedSize += ( alignment - ( xWantedSize & mask ) );