Safety instrumented function