/** \fn void cmscope(scicos_block * block,int flag)
\brief the computational function
\param block A pointer to a scicos_block
\param flag An int which indicates the state of the block (init, update, ending)
*/
SCICOS_BLOCKS_IMPEXP void canimxy3d(scicos_block * block, scicos_flag flag)
{
char const* pFigureUID;
sco_data *sco;
int j;
BOOL result;
switch (flag)
{
case Initialization:
sco = getScoData(block);
if (sco == NULL)
{
set_block_error(-5);
break;
}
pFigureUID = getFigure(block);
if (pFigureUID == NULL)
{
// allocation error
set_block_error(-5);
break;
}
break;
case StateUpdate:
pFigureUID = getFigure(block);
if (pFigureUID == NULL)
{
// allocation error
set_block_error(-5);
break;
}
appendData(block, block->inptr[0], block->inptr[1], block->inptr[2]);
for (j = 0; j < block->insz[0]; j++)
{
result = pushData(block, j);
if (result == FALSE)
{
Coserror("%s: unable to push some data.", "cscopxy3d");
break;
}
}
break;
case Ending:
freeScoData(block);
break;
default:
break;
}
}
/** \fn void cmscope(scicos_block * block,int flag)
\brief the computational function
\param block A pointer to a scicos_block
\param flag An int which indicates the state of the block (init, update, ending)
*/
SCICOS_BLOCKS_IMPEXP void cscopxy3d(scicos_block * block, scicos_flag flag)
{
int iFigureUID;
sco_data *sco;
int j;
BOOL result;
switch (flag)
{
case Initialization:
sco = getScoData(block);
if (sco == NULL)
{
set_block_error(-5);
}
iFigureUID = getFigure(block);
if (iFigureUID == 0)
{
// allocation error
set_block_error(-5);
}
break;
case StateUpdate:
iFigureUID = getFigure(block);
if (iFigureUID == 0)
{
// allocation error
set_block_error(-5);
break;
}
appendData(block, GetRealInPortPtrs(block, 1), GetRealInPortPtrs(block, 2), GetRealInPortPtrs(block, 3));
for (j = 0; j < block->insz[0]; j++)
{
result = pushData(block, j);
if (result == FALSE)
{
Coserror("%s: unable to push some data.", "cscopxy3d");
break;
}
}
break;
case Ending:
freeScoData(block);
break;
default:
break;
}
}
/** \fn void cmatview(scicos_block * block,int flag)
\brief the computational function
\param block A pointer to a scicos_block
\param flag An int which indicates the state of the block (init, update, ending)
*/
SCICOS_BLOCKS_IMPEXP void cmatview(scicos_block * block, scicos_flag flag)
{
char const* pFigureUID;
double *u;
sco_data *sco;
BOOL result;
switch (flag)
{
case Initialization:
sco = getScoData(block);
if (sco == NULL)
{
set_block_error(-5);
break;
}
pFigureUID = getFigure(block);
if (pFigureUID == NULL)
{
// allocation error
set_block_error(-5);
break;
}
break;
case StateUpdate:
pFigureUID = getFigure(block);
if (pFigureUID == NULL)
{
// allocation error
set_block_error(-5);
break;
}
u = GetRealInPortPtrs(block, 1);
result = pushData(block, u);
if (result == FALSE)
{
Coserror("%s: unable to push some data.", "cmatview");
break;
}
break;
case Ending:
freeScoData(block);
break;
default:
break;
}
}
static sco_data *reallocScoData(scicos_block * block, int input, int numberOfPoints)
{
sco_data *sco = (sco_data *) * (block->work);
int i, j;
double *ptr;
int setLen;
int previousNumberOfPoints = sco->internal.maxNumberOfPoints[input];
#ifndef S_SPLINT_S
LOG("%s: %s at %d to %d\n", "cmscope", "reallocScoData", input, numberOfPoints);
#endif /* !S_SPLINT_S */
for (i = 0; i < block->nin; i++)
{
for (j = 0; j < block->insz[i]; j++)
{
ptr = (double *)REALLOC(sco->internal.data[i][j], numberOfPoints * sizeof(double));
if (ptr == NULL)
{
goto error_handler;
}
for (setLen = numberOfPoints - previousNumberOfPoints - 1; setLen >= 0; setLen--)
{
ptr[previousNumberOfPoints + setLen] = ptr[previousNumberOfPoints - 1];
}
sco->internal.data[i][j] = ptr;
}
}
ptr = (double *)REALLOC(sco->internal.time[input], numberOfPoints * sizeof(double));
if (ptr == NULL)
{
goto error_handler;
}
for (setLen = numberOfPoints - previousNumberOfPoints - 1; setLen >= 0; setLen--)
{
ptr[previousNumberOfPoints + setLen] = ptr[previousNumberOfPoints - 1];
}
sco->internal.time[input] = ptr;
sco->internal.maxNumberOfPoints[input] = numberOfPoints;
return sco;
error_handler:
freeScoData(block);
// allocation error
set_block_error(-5);
return NULL;
}
static sco_data *reallocScoData(scicos_block * block, int input, int numberOfPoints)
{
sco_data *sco = getScoData(block);
double *ptr;
int setLen;
int previousNumberOfPoints = sco->internal.maxNumberOfPoints[input];
/*
* Realloc base pointer
*/
ptr = (double *)REALLOC(sco->internal.data[2 * input], 3 * numberOfPoints * sizeof(double));
if (ptr == NULL)
{
goto error_handler;
}
for (setLen = numberOfPoints - previousNumberOfPoints - 1; setLen >= 0; setLen--)
{
ptr[3 * (previousNumberOfPoints + setLen) + 0] = ptr[3 * (previousNumberOfPoints - 1) + 0];
ptr[3 * (previousNumberOfPoints + setLen) + 1] = ptr[3 * (previousNumberOfPoints - 1) + 1];
ptr[3 * (previousNumberOfPoints + setLen) + 2] = ptr[3 * (previousNumberOfPoints - 1) + 2];
}
sco->internal.data[2 * input] = ptr;
/*
* Realloc direction pointer
*/
ptr = (double *)REALLOC(sco->internal.data[2 * input + 1], 3 * numberOfPoints * sizeof(double));
if (ptr == NULL)
{
goto error_handler;
}
for (setLen = numberOfPoints - previousNumberOfPoints - 1; setLen >= 0; setLen--)
{
ptr[3 * (previousNumberOfPoints + setLen) + 0] = ptr[3 * (previousNumberOfPoints - 1) + 0];
ptr[3 * (previousNumberOfPoints + setLen) + 1] = ptr[3 * (previousNumberOfPoints - 1) + 1];
ptr[3 * (previousNumberOfPoints + setLen) + 2] = ptr[3 * (previousNumberOfPoints - 1) + 2];
}
sco->internal.data[2 * input + 1] = ptr;
sco->internal.maxNumberOfPoints[input] = numberOfPoints;
return sco;
error_handler:
freeScoData(block);
// allocation error
set_block_error(-5);
return NULL;
}
static sco_data *reallocScoData(scicos_block * block, int numberOfPoints)
{
sco_data *sco = (sco_data *) * (block->work);
int i;
double *ptr;
int setLen;
int previousNumberOfPoints = sco->internal.maxNumberOfPoints;
int newPoints = numberOfPoints - previousNumberOfPoints;
for (i = 0; i < block->insz[0]; i++)
{
ptr = (double *)REALLOC(sco->internal.coordinates[i], 3 * numberOfPoints * sizeof(double));
if (ptr == NULL)
{
goto error_handler;
}
// memcpy existing Z-axis values (use memmove to handle memory overlapping)
memmove(ptr + 2 * numberOfPoints, ptr + 2 * previousNumberOfPoints, previousNumberOfPoints * sizeof(double));
// memcpy existing Y-axis values (use memmove to handle memory overlapping)
memmove(ptr + numberOfPoints, ptr + previousNumberOfPoints, previousNumberOfPoints * sizeof(double));
// then set the last points to the last values for Z-axis, Y-axis and X-axis values
for (setLen = newPoints - 1; setLen >= 0; setLen--)
{
ptr[2 * numberOfPoints + previousNumberOfPoints + setLen] = ptr[2 * numberOfPoints + previousNumberOfPoints - 1];
}
for (setLen = newPoints - 1; setLen >= 0; setLen--)
{
ptr[numberOfPoints + previousNumberOfPoints + setLen] = ptr[numberOfPoints + previousNumberOfPoints - 1];
}
for (setLen = newPoints - 1; setLen >= 0; setLen--)
{
ptr[previousNumberOfPoints + setLen] = ptr[previousNumberOfPoints - 1];
}
sco->internal.coordinates[i] = ptr;
}
sco->internal.maxNumberOfPoints = numberOfPoints;
return sco;
error_handler:
freeScoData(block);
// allocation error
set_block_error(-5);
return NULL;
}
static void appendData(scicos_block * block, int input, double t)
{
sco_data *sco = getScoData(block);
int maxNumberOfPoints = sco->internal.maxNumberOfPoints[input];
int numberOfPoints = sco->internal.numberOfPoints[input];
int i;
int nclk = block->nipar - 6;
/*
* Handle the case where the t is greater than the data_bounds
*/
if (t > ((sco->scope.periodCounter + 1) * block->rpar[0]))
{
sco->scope.periodCounter++;
// reset the number of points for all the segs
numberOfPoints = 0;
for (i = 0; i < nclk; i++)
{
sco->internal.numberOfPoints[i] = 0;
}
if (setBounds(block, getAxe(getFigure(block), block), sco->scope.periodCounter) == FALSE)
{
set_block_error(-5);
freeScoData(block);
sco = NULL;
}
}
/*
* Handle the case where the scope has more points than maxNumberOfPoints
*/
if (sco != NULL && numberOfPoints >= maxNumberOfPoints)
{
// on a full scope, re-alloc
maxNumberOfPoints = maxNumberOfPoints + DEFAULT_MAX_NUMBER_OF_POINTS;
sco = reallocScoData(block, input, maxNumberOfPoints);
// reconfigure related graphic objects
if (setSegsBuffers(block, maxNumberOfPoints) == FALSE)
{
set_block_error(-5);
freeScoData(block);
sco = NULL;
}
}
/*
* Update data
*/
if (sco != NULL)
{
int setLen;
/*
* Base pointer
*/
for (setLen = maxNumberOfPoints - numberOfPoints - 1; setLen >= 0; setLen--)
{
sco->internal.data[2 * input + 0][3 * (numberOfPoints + setLen) + 0] = t; // x
sco->internal.data[2 * input + 0][3 * (numberOfPoints + setLen) + 1] = 0; // y
sco->internal.data[2 * input + 0][3 * (numberOfPoints + setLen) + 2] = (double) input; // z
}
/*
* Direction pointer
*/
for (setLen = maxNumberOfPoints - numberOfPoints - 1; setLen >= 0; setLen--)
{
sco->internal.data[2 * input + 1][3 * (numberOfPoints + setLen) + 0] = t; // x
sco->internal.data[2 * input + 1][3 * (numberOfPoints + setLen) + 1] = 0.8; // y
sco->internal.data[2 * input + 1][3 * (numberOfPoints + setLen) + 2] = (double) input; // z
}
sco->internal.numberOfPoints[input]++;
}
}
/** \fn void cscope(scicos_block * block,int flag)
\brief the computational function
\param block A pointer to a scicos_block
\param flag An int which indicates the state of the block (init, update, ending)
*/
SCICOS_BLOCKS_IMPEXP void cevscpe(scicos_block * block, scicos_flag flag)
{
int iFigureUID;
double t;
int i;
int mask;
int nclk = block->nipar - 6;
sco_data *sco;
BOOL result;
switch (flag)
{
case Initialization:
sco = getScoData(block);
if (sco == NULL)
{
set_block_error(-5);
}
iFigureUID = getFigure(block);
if (iFigureUID == 0)
{
// allocation error
set_block_error(-5);
break;
}
setSegsBuffers(block, DEFAULT_MAX_NUMBER_OF_POINTS);
break;
case StateUpdate:
iFigureUID = getFigure(block);
if (iFigureUID == 0)
{
// allocation error
set_block_error(-5);
break;
}
t = get_scicos_time();
// select only the masked indexes
for (i = 0; i < nclk; i++)
{
mask = 1 << i;
if ((block->nevprt & mask) == mask)
{
appendData(block, i, t);
result = pushData(block, i);
if (result == FALSE)
{
Coserror("%s: unable to push some data.", "cevscpe");
break;
}
}
}
break;
case Ending:
freeScoData(block);
break;
default:
break;
}
}
static void appendData(scicos_block * block, int input, double t, double *data)
{
int i;
sco_data *sco = (sco_data *) * (block->work);
int maxNumberOfPoints = sco->internal.maxNumberOfPoints[input];
int numberOfPoints = sco->internal.numberOfPoints[input];
/*
* Handle the case where the t is greater than the data_bounds
*/
if (t > ((sco->scope.periodCounter[input] + 1) * block->rpar[1 + input]))
{
sco->scope.periodCounter[input]++;
numberOfPoints = 0;
sco->internal.numberOfPoints[input] = 0;
if (setPolylinesBounds(block, input, sco->scope.periodCounter[input]) == FALSE)
{
set_block_error(-5);
freeScoData(block);
sco = NULL;
}
}
/*
* Handle the case where the scope has more points than maxNumberOfPoints
*/
if (sco != NULL && numberOfPoints >= maxNumberOfPoints)
{
// on a full scope, re-alloc
maxNumberOfPoints = maxNumberOfPoints + block->ipar[2];
sco = reallocScoData(block, input, maxNumberOfPoints);
// reconfigure related graphic objects
if (setPolylinesBuffers(block, input, maxNumberOfPoints) == FALSE)
{
set_block_error(-5);
freeScoData(block);
sco = NULL;
}
}
/*
* Update data
*/
if (sco != NULL)
{
int setLen;
for (i = 0; i < block->insz[input]; i++)
{
for (setLen = maxNumberOfPoints - numberOfPoints - 1; setLen >= 0; setLen--)
{
sco->internal.data[input][i][numberOfPoints + setLen] = data[i];
}
}
for (setLen = maxNumberOfPoints - numberOfPoints - 1; setLen >= 0; setLen--)
{
sco->internal.time[input][numberOfPoints + setLen] = t;
}
sco->internal.numberOfPoints[input]++;
}
}
/** \fn void cmscope(scicos_block * block,int flag)
\brief the computational function
\param block A pointer to a scicos_block
\param flag An int which indicates the state of the block (init, update, ending)
*/
SCICOS_BLOCKS_IMPEXP void cmscope(scicos_block * block, scicos_flag flag)
{
char const* pFigureUID;
double t;
double *u;
sco_data *sco;
int i, j;
BOOL result;
switch (flag)
{
case Initialization:
sco = getScoData(block);
if (sco == NULL)
{
set_block_error(-5);
break;
}
pFigureUID = getFigure(block);
if (pFigureUID == NULL)
{
// allocation error
set_block_error(-5);
break;
}
break;
case StateUpdate:
pFigureUID = getFigure(block);
if (pFigureUID == NULL)
{
// allocation error
set_block_error(-5);
break;
}
t = get_scicos_time();
for (i = 0; i < block->nin; i++)
{
u = (double *)block->inptr[i];
appendData(block, i, t, u);
for (j = 0; j < block->insz[i]; j++)
{
result = pushData(block, i, j);
if (result == FALSE)
{
Coserror("%s: unable to push some data.", "cmscope");
break;
}
}
}
break;
case Ending:
freeScoData(block);
break;
default:
break;
}
}