*/
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;
/*Configuration of desired counter modes*/
mf624_write32(CTRX_MODE,MFST2REG(mfst,4,CTR0MODE));
unsigned int period;
unsigned int c0,c1,c2,c4;
-
+ if (mf624_check(S) != 0)
+ return;
+
c0 = mf624_read32(MFST2REG(mfst,4,CTR0));
c1 = mf624_read32(MFST2REG(mfst,4,CTR1));
c2 = mf624_read32(MFST2REG(mfst,4,CTR2));
*/
static void mdlTerminate(SimStruct *S)
{
- if(mfst!=NULL){
- mf624_write32(CTR_STOP,MFST2REG(mfst,4,CTRXCTRL));
- free(mfst);
- mfst=NULL;
- } else {
- 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;
- }
- mf624_write32(CTR_STOP,MFST2REG(mfst,4,CTRXCTRL));
- free(mfst);
- mfst=NULL;
- }
+ if (mf624_check(NULL) != 0)
+ return;
+
+ mf624_write32(CTR_STOP,MFST2REG(mfst,4,CTRXCTRL));
+ mf624_done();
}