/*
- * 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.
*/
* its associated macro definitions.
*/
#include "simstruc.h"
+
+#ifndef WITHOUT_HW
#include "mf624_SIMULINK.h"
+#endif /*WITHOUT_HW*/
/* Error handling
* --------------
*/
static void mdlStart(SimStruct *S)
{
- if (mf624_init(S) != 0)
+ #ifndef WITHOUT_HW
+ if (mf624_init(NULL) != 0)
return;
DAC_enable(mfst);
+ #endif /*WITHOUT_HW*/
//ssSetPWorkValue(S, 0, mfst);
}
#endif /* MDL_START */
const real_T *u = (const real_T*) ssGetInputPortSignal(S,0);
//mf624_state_t* mfst = ssGetPWorkValue(S,0);
int out;
+
+ #ifndef WITHOUT_HW
+ if (mf624_check(S) != 0)
+ return;
+
if(u[0] > 9.9988){
out = 0x3FFF;
}
out = (int) ((u[0] + 10) * 8192 / 10 + 0.5);
}
mf624_write16(out, MFST2REG(mfst, 2, dac_channel2reg[(int)CHNL_PRM(S)-1]));
+ #endif /*WITHOUT_HW*/
}
*/
static void mdlTerminate(SimStruct *S)
{
+ #ifndef WITHOUT_HW
//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();
+ #endif /*WITHOUT_HW*/
}