Added (limited) SafeRTOS support