Updated stm32 output function. Made chibios mutexes recursive.