现代通信系统使用MATLAB全.zip

/* $Revision: 1.23 $ */ /* * HOMOPULS A Simulink homonic pulse generator. * * Syntax: [sys, x0] = homopuls(t,x,u,flag,sample,divider,offset) * * Wes Wang 8/18/1994 revised 1/24/1996. * Copyright 1996-2001 The MathWorks, Inc. */ #define S_FUNCTION_NAME homopuls #ifdef MATLAB_MEX_FILE #include "mex.h" /* needed for declaration of mexErrMsgTxt */ #endif /* * need to include simstruc.h for the definition of the SimStruct and * its associated macro definitions. */ #include "simstruc.h" #include "tmwtypes.h" #include <math.h> /* For RTW */ #if defined(RT) || defined(NRT) #undef mexPrintf #define mexPrintf printf #endif /* * Defines for easy access of the input parameters */ #define NUM_ARGS 3 #define SAMPLE_TIME ssGetArg(S,0) #define DIVIDER_EACH ssGetArg(S,1) #define OFFSET_EACH ssGetArg(S,2) /* * mdlInitializeSizes - called to initialize the sizes array stored in * the SimStruct. The sizes array defines the * characteristics (number of inputs, outputs, * states, etc.) of the S-Function. */ static int_T isclose(real_T a, real_T b) { #define EPS 4.656612875245797e-10 /* reciprocal of 2^31-1 */ real_T diff; #ifdef MATLAB_MEX_FILE if (0) { char_T err_msg[255]; sprintf(err_msg, "a %f, b %f \n", a, b); mexPrintf(err_msg); } #endif diff = fabs(a - b); if (diff * 1.e-5 /(fabs(a) + EPS) < EPS) return(1); else return(0); } static void mdlInitializeSizes(SimStruct *S) { /* * Set-up size information. */ int_T NumSampleTime; if (ssGetNumArgs(S) == NUM_ARGS) { int_T dividerSize; if ((mxGetN(SAMPLE_TIME) * mxGetM(SAMPLE_TIME)) > 1) { #ifdef MATLAB_MEX_FILE mexErrMsgTxt("The sample time is a scalar."); #endif } if ((mxGetN(DIVIDER_EACH) != 1) && (mxGetM(DIVIDER_EACH) != 1)) { #ifdef MATLAB_MEX_FILE mexErrMsgTxt("The divider must be a vector"); #endif } if ((mxGetN(OFFSET_EACH) != 1) && (mxGetM(OFFSET_EACH) != 1)) { #ifdef MATLAB_MEX_FILE mexErrMsgTxt("The offset must be a vector"); #endif } if ((mxGetN(OFFSET_EACH) * (mxGetM(OFFSET_EACH))) != ((mxGetN(DIVIDER_EACH) * (mxGetM(DIVIDER_EACH))))) { #ifdef MATLAB_MEX_FILE mexErrMsgTxt("Divider and Offset must have the same length"); #endif } dividerSize = mxGetN(DIVIDER_EACH) * mxGetM(DIVIDER_EACH); NumSampleTime = dividerSize; if (dividerSize > 0) { real_T sampleTime, sampleTimeI, offsetTimeI; int_T adj, i; real_T *past_sample, *past_offset; past_sample = (real_T *)calloc(dividerSize, sizeof(real_T)); past_offset = (real_T *)calloc(dividerSize, sizeof(real_T)); sampleTime = mxGetPr(SAMPLE_TIME)[0]; NumSampleTime = 0; for (i=0; i < dividerSize; i++) { offsetTimeI = mxGetPr(OFFSET_EACH)[i]; sampleTimeI = sampleTime/2./mxGetPr(DIVIDER_EACH)[i]; if (sampleTimeI <= 0) { #ifdef MATLAB_MEX_FILE mexErrMsgTxt("Sample time must be positive number."); #endif } while (offsetTimeI < 0) offsetTimeI += sampleTimeI; adj = (int_T)(offsetTimeI / sampleTimeI); offsetTimeI = offsetTimeI - ((real_T)adj) * sampleTimeI; #ifdef MATLAB_MEX_FILE if (0) { char_T err_msg[255]; sprintf(err_msg, "Iteration %d, offsetTimeI %f, sampleTimeI %f \n", i, offsetTimeI, sampleTimeI); mexPrintf(err_msg); } #endif if ((isclose(offsetTimeI, 0.0)) || (isclose(offsetTimeI, sampleTimeI))) offsetTimeI = 0; if (i > 0) { int_T test_flag, ii; test_flag = 1; for (ii = 0; ii<NumSampleTime; ii++) { #ifdef MATLAB_MEX_FILE if (0) { char_T err_msg[255]; sprintf(err_msg, "sampleTimeI %f, past_sample[ii] %f, offsetTimeI %f, past_offset[ii] %f \n", sampleTimeI, past_sample[ii], offsetTimeI, past_offset[ii]); mexPrintf(err_msg); } #endif if ((isclose(sampleTimeI, past_sample[ii])) && (isclose(offsetTimeI, past_offset[ii]))) test_flag = 0; } if (test_flag) { past_sample[NumSampleTime] = sampleTimeI; past_offset[NumSampleTime] = offsetTimeI; NumSampleTime++; } } else { past_sample[NumSampleTime] = sampleTimeI; past_offset[NumSampleTime] = offsetTimeI; NumSampleTime++; } } free(past_sample); free(past_offset); } #ifdef MATLAB_MEX_FILE if (0) { char_T err_msg[255]; sprintf(err_msg, "NumSampleTime %d: \n", NumSampleTime); mexPrintf(err_msg); } #endif ssSetNumContStates( S, 0); ssSetNumDiscStates( S, 0); ssSetNumInputs( S, 0); ssSetNumOutputs( S, dividerSize); ssSetDirectFeedThrough(S, 0); ssSetNumInputArgs( S, NUM_ARGS); ssSetNumSampleTimes( S, NumSampleTime); ssSetNumRWork( S, 4*dividerSize+2); /* store the timing */ ssSetNumIWork( S, dividerSize); /* store the last time access. */ ssSetNumPWork( S, 0); } else { #ifdef MATLAB_MEX_FILE char_T err_msg[256]; sprintf(err_msg, "Wrong number of input arguments passed to S-function MEX-file.\n %d input arguments were passed in when expecting %d input arguments.\n", ssGetNumArgs(S) + 4, NUM_ARGS + 4); mexErrMsgTxt(err_msg); #endif } } /* * mdlInitializeSampleTimes - initializes the array of sample times stored in * the SimStruct associated with this S-Function. */ static void mdlInitializeSampleTimes(SimStruct *S) { int_T dividerSize, NumSampleTime; int_T NumSmpTm = ssGetNumSampleTimes(S); dividerSize = mxGetN(DIVIDER_EACH) * mxGetM(DIVIDER_EACH); NumSampleTime = dividerSize; if (dividerSize > 0) { real_T sampleTime, sampleTimeI, offsetTimeI; int_T adj, i; real_T *past_sample, *past_offset; past_sample = (real_T *)calloc(dividerSize, sizeof(real_T)); past_offset = (real_T *)calloc(dividerSize, sizeof(real_T)); sampleTime = mxGetPr(SAMPLE_TIME)[0]; NumSampleTime = 0; for (i=0; i < dividerSize; i++) { offsetTimeI = mxGetPr(OFFSET_EACH)[i]; sampleTimeI = sampleTime/2./mxGetPr(DIVIDER_EACH)[i]; while (offsetTimeI < 0) offsetTimeI += sampleTimeI; adj = (int_T)(offsetTimeI / sampleTimeI); offsetTimeI = offsetTimeI - ((real_T)adj) * sampleTimeI; if ((isclose(offsetTimeI, 0.0)) || (isclose(offsetTimeI, sampleTimeI))) offsetTimeI = 0; while (offsetTimeI > sampleTimeI) offsetTimeI -= sampleTimeI; if (i > 0) { int_T test_flag, ii; test_flag = 1; for (ii = 0; ii<NumSampleTime; ii++) { if ((isclose(sampleTimeI, past_sample[ii])) && (isclose(offsetTimeI, past_offset[ii]))) test_flag = 0; } if (test_flag) { past_sample[NumSampleTime] = sampleTimeI; past_offset[NumSampleTime] = offsetTimeI; #ifdef MATLAB_MEX_FILE if (0) { char_T err_msg[255]; sprintf(err_msg, "Sample Time: %f, Offset Time: %f\n", sampleTimeI, offsetTimeI); mexPrintf(err_msg); } #endif ssSetSampleTimeEvent(S, NumSampleTime, sampleTimeI); ssSetOffsetTimeEvent(S, NumSampleTime, offsetTimeI); NumSampleTime++; } } else { past_sample[NumSampleTime] = sampleTimeI; past_offset[NumSampleTime] = offsetTimeI; #ifdef MATLAB_MEX_FILE if (0) { char_T err_msg[255]; sprintf(err_msg, "Sample Time: %f, Offset Time: %f", sampleTimeI, offsetTimeI); mexPrintf(err_msg); } #endif ssSetSampleTimeEvent(S, NumSampleTime, sampleTimeI);