Initial commit

src/platform/f7-disco-gcc/mcu/critical/critical.cpp

@@ -0,0 +1,41 @@
+#include "mcu/mcu.h"
+#include "critical.h"
+
+volatile int bInISR = 0;
+volatile int bOMEnterCriticalRegionNested = 0;
+
+int inISR()
+{
+	// Variable must be put to TRUE in every ISR to indicate execution
+	// of an ISR and need to put back to FALSE before leaving ISR.
+	return bInISR;
+}
+
+void enterCritical()
+{
+	// Only disable interrupts when not calling from an ISR
+	if (!inISR())
+	{
+		if (!bOMEnterCriticalRegionNested)
+		{
+			// Turn off the priority configurable interrupts
+		    __disable_irq();
+		}
+		bOMEnterCriticalRegionNested++;
+	}
+}
+
+void exitCritical()
+{
+	// Only enable interrupts when not calling from an ISR
+	if (!inISR())
+	{
+		bOMEnterCriticalRegionNested--;
+
+		if (!bOMEnterCriticalRegionNested)
+		{
+			// Turn on the interrupts with configurable priority
+		    __enable_irq();
+		}
+	}
+}