1 files changed, 14 insertions, 0 deletions
diff --git a/src/gos/freertos.c b/src/gos/freertos.c
index 872807d1..e3be4f28 100644
--- a/src/gos/freertos.c
+++ b/src/gos/freertos.c
@@ -107,6 +107,20 @@ bool_t gfxSemWait(gfxSem* psem, delaytime_t ms)
 	return FALSE;
 }
 
+bool_t gfxSemWaitI(gfxSem* psem)
+{
+	portBASE_TYPE xHigherPriorityTaskWoken = pdFALSE;
+
+	psem->counter--;
+
+	if (xSemaphoreTakeFromISR(psem->sem,&xHigherPriorityTaskWoken) == pdTRUE)
+		return TRUE;
+
+	psem->counter++;
+
+	return FALSE;
+}
+
 void gfxSemSignal(gfxSem* psem)
 {
 	taskENTER_CRITICAL();