Implement Mutex around FreeRTOS semaphore