]> rtime.felk.cvut.cz Git - mf624-simulink.git/blobdiff - sfDigitalOutput.c
Define FIXED_IN_MINOR_STEP_OFFSET for external input blocks instead of 0.0 offset.
[mf624-simulink.git] / sfDigitalOutput.c
index 61dc5b101d24b1bc4a8495edbe0d0ddf6c331632..81c06077864daa189e0945e32e8c2f964754c4b1 100644 (file)
@@ -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(NULL) != 0)
+       return;
     mfst->DOut=0;
     
   }
@@ -181,7 +163,10 @@ static void mdlInitializeSampleTimes(SimStruct *S)
 static void mdlOutputs(SimStruct *S, int_T tid)
 {
     const real_T *u = (const real_T*) ssGetInputPortSignal(S,0);
-    mf624_state_t* mfst = ssGetPWorkValue(S,0);
+
+    if (mf624_check(S) != 0)
+           return;
+
     if(u[0] > 0.5){
         /*Update the "word" holding Output Values*/
         mfst->DOut |= (1 << (int)(CHNL_PRM(S)-1));
@@ -234,9 +219,7 @@ static void mdlOutputs(SimStruct *S, int_T tid)
  */
 static void mdlTerminate(SimStruct *S)
 {
-    if(mfst!=NULL){
-        free(ssGetPWorkValue(S,0));
-    }
+       mf624_done();
 }