What is alternatives of those calls?
Malloc(),printf() It takes long amount of execution time. semTake() may block the ISR