Example of use of PWM combined with digital direction output.

[mf624-simulink.git] / sfAnalogOutput.c

diff --git a/sfAnalogOutput.c b/sfAnalogOutput.c
index 0b59e1923f069216ba3bb1cf8198c4df5d731a4b..3056060fac1d170a90b51b8d42cbc9b601659df6 100644 (file)
--- a/sfAnalogOutput.c
+++ b/sfAnalogOutput.c
@@ -1,12 +1,34 @@
 /*
- * sfuntmpl_basic.c: Basic 'C' template for a level 2 S-function.
+ * S-function to support analog outputs on Humusoft MF624 card
  *
- *  -------------------------------------------------------------------------
- *  | See matlabroot/simulink/src/sfuntmpl_doc.c for a more detailed template |
- *  -------------------------------------------------------------------------
+ * Copyright (C) 2013 Michal Kreč <krecmich@fel.cvut.cz>
+ * Copyright (C) 2013 Michal Sojka <sojkam1@fel.cvut.cz>
  *
- * Copyright 1990-2002 The MathWorks, Inc.
- * $Revision: 1.27.4.2 $
+ * Department of Control Engineering
+ * Faculty of Electrical Engineering
+ * Czech Technical University in Prague (CTU)
+ *
+ * The S-Function for ERT Linux can be distributed in compliance
+ * with GNU General Public License (GPL) version 2 or later.
+ * Other licence can negotiated with CTU.
+ *
+ * Next exception is granted in addition to GPL.
+ * Instantiating or linking compiled version of this code
+ * to produce an application image/executable, does not
+ * by itself cause the resulting application image/executable
+ * to be covered by the GNU General Public License.
+ * This exception does not however invalidate any other reasons
+ * why the executable file might be covered by the GNU Public License.
+ * Publication of enhanced or derived S-function files is required
+ * although.
+ *
+ * Linux ERT code is available from
+ *    http://rtime.felk.cvut.cz/gitweb/ert_linux.git
+ * More CTU Linux target for Simulink components are available at
+ *    http://lintarget.sourceforge.net/
+ *
+ * sfuntmpl_basic.c by The MathWorks, Inc. has been used to accomplish
+ * required S-function structure.
  */
 
 
@@ -146,23 +168,8 @@ static void mdlInitializeSampleTimes(SimStruct *S)
    */
   static void mdlStart(SimStruct *S)
   {
-    if(mfst==NULL){
-        mfst = malloc(sizeof(mf624_state_t));
-        char buff[32];
-        mfst->uio_dev = "uio0";
-       snprintf(buff, sizeof(buff), "/dev/%s", mfst->uio_dev);
-
-        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;
        DAC_enable(mfst);
     //ssSetPWorkValue(S, 0, mfst);
   }
@@ -180,6 +187,10 @@ 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);
     int out;
+
+    if (mf624_check(S) != 0)
+           return;
+
     if(u[0] > 9.9988){
         out = 0x3FFF;
     }
@@ -233,39 +244,15 @@ static void mdlOutputs(SimStruct *S, int_T tid)
 static void mdlTerminate(SimStruct *S)
 {
     //mf624_state_t* mfst = ssGetPWorkValue(S,0);
+    if (mf624_check(NULL) != 0)
+           return;
+
     /*At the end of simulation disable D/A outputs*/
-    if(mfst != NULL){
-        mf624_write32((mf624_read32(MFST2REG(mfst, 0, GPIOC_reg))
-            & ~GPIOC_DACEN_mask), // disable output,
-            MFST2REG(mfst, 0, GPIOC_reg));
-        free(mfst);
-        mfst=NULL;
-    } else {
-        mfst = malloc(sizeof(mf624_state_t));
-        #define BUFF_SMALL             32
-        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;
-        }   
-        mf624_write32((mf624_read32(MFST2REG(mfst, 0, GPIOC_reg))
-            & ~GPIOC_DACEN_mask), // disable output,
-            MFST2REG(mfst, 0, GPIOC_reg));
-        free(mfst);
-        mfst=NULL;
-    }
-    
+    mf624_write32((mf624_read32(MFST2REG(mfst, 0, GPIOC_reg))
+                  & ~GPIOC_DACEN_mask), // disable output,
+                 MFST2REG(mfst, 0, GPIOC_reg));
+
+    mf624_done();
 }