Simulink C Function