addScan.c

/* addScan.c
*
*  add a new scan rate to the ioc
*
* Copyright (C) 2011 Dirk Zimoch
*
* This program is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program.  If not, see <https://www.gnu.org/licenses/>.
*/

#include <string.h>
#include <stdlib.h>
#ifdef vxWorks
#include <sysLib.h>
#endif

#include "dbScan.h"
#include "dbStaticLib.h"
#include "dbAccess.h"
#include "epicsVersion.h"
#ifdef BASE_VERSION
#define EPICS_3_13
extern DBBASE *pdbbase;
#else
#include "iocsh.h"
#include "epicsStdioRedirect.h"
#include "epicsExport.h"
#endif

int addScan (char* ratestr)
{
    dbMenu  *menuScan;
    size_t  l;
    int     i, j, nChoice;
    char    **papChoiceName;
    char    **papChoiceValue;
    double  rate, r;
    char    dummy;
    char    *name;

    if (interruptAccept)
    {
        fprintf(stderr, "addScan: Can add a scan period only before iocInit!\n");
        return -1;
    }
    if (!ratestr || sscanf (ratestr, "%lf%c", &rate, &dummy) != 1 || rate <= 0)
    {
        fprintf(stderr, "addScan: Argument '%s' must be a number > 0\n", ratestr);
        return -1;
    }
    menuScan = dbFindMenu(pdbbase,"menuScan");
    nChoice = menuScan->nChoice;
    for (i=SCAN_1ST_PERIODIC; i < nChoice; i++)
    {
        r = strtod(menuScan->papChoiceValue[i], NULL);
        if (r == rate)
        {
            fprintf(stderr, "addScan: rate %s already available\n", menuScan->papChoiceValue[i]);
            return 0;
        }
        if (r < rate) break;
    }
    papChoiceName=dbCalloc(nChoice+1,sizeof(char*));
    papChoiceValue=dbCalloc(nChoice+1,sizeof(char*));
    for (j = 0; j < i; j++)
    {
        papChoiceName[j] = menuScan->papChoiceName[j];
        papChoiceValue[j] = menuScan->papChoiceValue[j];
    }
    name = ratestr;
    while (name[0]=='0') name++;
    l = strlen(name);
    papChoiceValue[i] = dbCalloc(l+16,1);
    strcpy(papChoiceValue[i], name);
    strcpy(papChoiceValue[i]+l, " second");
    for (j = i; j < nChoice; j++)
    {
        papChoiceName[j+1] = menuScan->papChoiceName[j];
        papChoiceValue[j+1] = menuScan->papChoiceValue[j];
    }
    free(menuScan->papChoiceName);
    free(menuScan->papChoiceValue);
    menuScan->papChoiceName=papChoiceName;
    menuScan->papChoiceValue=papChoiceValue;
    menuScan->nChoice = nChoice+1;
#ifdef vxWorks
#ifndef SYS_CLK_RATE_MAX
#define SYS_CLK_RATE_MAX 5000
#endif
    i = (int)4/rate;
    if (sysClkRateGet() < i)
    {
        if (i > SYS_CLK_RATE_MAX)
        {
            i = SYS_CLK_RATE_MAX;
            fprintf(stderr, "addScan: sysClkRate is limited to %i Hz! Scan rate may not work as expected.\n", i);
        }
        fprintf(stderr, "addScan: increasing sysClkRate from %d to %d Hz\n",
            sysClkRateGet(), i);
        if (sysClkRateSet(i) != 0)
        {
            fprintf(stderr, "addScan: increasing sysClkRate failed! Scan rate may not work as expected.\n");
        }
    }
#endif
    return 0;
}

int rmScan (char* ratestr)
{
    dbMenu  *menuScan;
    int     i, nChoice;
    double  rate, r;
    char    dummy;

    if (interruptAccept)
    {
        fprintf(stderr, "rmScan: Can remove a scan period only before iocInit!\n");
        return -1;
    }
    if (!ratestr || sscanf (ratestr, "%lf%c", &rate, &dummy) != 1 || rate <= 0)
    {
        fprintf(stderr, "rmScan: Argument '%s' must be a number > 0\n", ratestr);
        return -1;
    }
    menuScan = dbFindMenu(pdbbase,"menuScan");
    nChoice = menuScan->nChoice;
    for (i=SCAN_1ST_PERIODIC; i < nChoice; i++)
    {
        r = strtod(menuScan->papChoiceValue[i], NULL);
        if (r == rate)
        {
            free(menuScan->papChoiceName[i]);
            free(menuScan->papChoiceValue[i]);
            while (++i < nChoice)
            {
                menuScan->papChoiceName[i-1] = menuScan->papChoiceName[i];
                menuScan->papChoiceValue[i-1] = menuScan->papChoiceValue[i];
            }
            menuScan->nChoice = nChoice-1;
            return 0;
        }
    }
    fprintf(stderr, "rmScan: rate %s does not exist\n", ratestr);
    return 0;
}

#ifndef EPICS_3_13
static const iocshArg addScanArg0 = { "rate", iocshArgString };
static const iocshArg * const addScanArgs[1] = { &addScanArg0 };
static const iocshFuncDef addScanDef = { "addScan", 1, addScanArgs };
static void addScanFunc (const iocshArgBuf *args)
{
    addScan(args[0].sval);
}

static const iocshArg rmScanArg0 = { "rate", iocshArgString };
static const iocshArg * const rmScanArgs[1] = { &rmScanArg0 };
static const iocshFuncDef rmScanDef = { "rmScan", 1, rmScanArgs };
static void rmScanFunc (const iocshArgBuf *args)
{
    rmScan(args[0].sval);
}
static void addScanRegister(void)
{
    iocshRegister (&addScanDef, addScanFunc);
    iocshRegister (&rmScanDef, rmScanFunc);
}
epicsExportRegistrar(addScanRegister);
#endif