Remove code duplication

[mf624-simulink.git] / sfDigitalOutput.c

diff --git a/sfDigitalOutput.c b/sfDigitalOutput.c
index 445c946458da2d5dcf1696b90b318af3522d7f1b..9d4d81b4d3c13104451f33f0df06c7f5a63a7417 100644 (file)
--- a/sfDigitalOutput.c
+++ b/sfDigitalOutput.c
@@ -146,26 +146,8 @@ static void mdlInitializeSampleTimes(SimStruct *S)
    */
   static void mdlStart(SimStruct *S)
   {
-    if(mfst==NULL){
-        #define BUFF_SMALL             32
-        mfst = malloc(sizeof(mf624_state_t));
-        char buff[BUFF_SMALL];
-        memset(buff, '\0', BUFF_SMALL);
-        mfst->uio_dev = "uio0";
-
-        strncat(buff, "/dev/", 5);
-        strncat(buff, mfst->uio_dev, sizeof(buff) - 6);
-
-        mfst->device_fd = open_device(buff);
-        if (mfst->device_fd < 0) {
-            ssSetErrorStatus(S,"open failed");
-            return;
-        }
-        if (mmap_regions(mfst) < 0) {
-            ssSetErrorStatus(S,"mmap_regions failed");
-            return;
-        }
-    }
+    if (mf624_init(S) != 0)
+       return;
     mfst->DOut=0;
     
   }