/*******************************************************************************
* Control.cc Control process
* T.Barnaby, BEAM Ltd, 2007-02-07
*******************************************************************************
*/
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <signal.h>
#include <fcntl.h>
#include <sys/stat.h>
#include <sys/socket.h>
#include <sys/mman.h>
#include <sys/vfs.h>
#include <sys/param.h>
#include <sys/time.h>
#include <netdb.h>
#include <main.h>
#include <Control.h>
#include <BEntry.h>
#include <BDir.h>
#include <BString.h>
#include <Debug.h>
#include <time.h>
#include <sys/ioctl.h>
#include <linux/watchdog.h>
#define SINGLE_DMA 1 ///< Only allow a single DMA accross the PCI bus at a time in getData
CycleParams::CycleParams(BString cycleType, CycleParam& params){
this->cycleType = cycleType;
this->params.append(params);
}
void ControlTimer::sigFunc(int sig, siginfo_t* sigInfo, void* data){
ControlTimer::timer->tick();
}
ControlTimer* ControlTimer::timer;
ControlTimer::ControlTimer(Control& control) : ocontrol(control){
timer = this;
}
void ControlTimer::tick(){
otick.post();
}
void ControlTimer::sync(){
struct itimerval t;
t.it_interval.tv_sec = 0;
t.it_interval.tv_usec = 100000;
t.it_value = t.it_interval;
setitimer(ITIMER_REAL, &t, NULL);
}
void* ControlTimer::function(){
struct sigaction sigAction;
sigset_t sigm;
dprintf(DBG_THREADS, "ControlTimer Thread: %d\n", gettid());
sigemptyset(&sigm);
sigaddset(&sigm, SIGALRM);
sigprocmask(SIG_UNBLOCK, &sigm, 0);
memset(&sigAction, 0, sizeof(sigAction));
sigAction.sa_sigaction = ControlTimer::sigFunc;
sigAction.sa_flags = SA_SIGINFO;
sigaction(SIGALRM, &sigAction, NULL);
sync();
while(1){
otick.wait();
ocontrol.timer();
}
return 0;
}
Control::Control(int dbFixed) :
odebugFixed(dbFixed),
otimer(*this),
opuControlServer(*this, oboapServer, "puControl"),
opuProcessServer(*this, oboapServer, "puProcess"){
onum = 0;
memset(oinitialised, 0, sizeof(oinitialised));
omaster = 0;
orings = 0;
osimulate = 0;
osimulateTiming = 0;
ocycleNumberNext = 0;
oprocessingCycle = 0;
oserverName = "localhost";
ocycleTick = 12;
ostartTime = getTime();
ocycleProcessed = 0;
owatchdog = -1;
}
Control::~Control(){
}
BString Control::getName(){
return BString("Module") + moduleNum() + ": ";
}
BError Control::mergeError(BError err){
if(err){
err.set(err.getErrorNo(), getName() + err.getString());
}
return err;
}
BError Control::init(int number){
BError err;
BString s;
sched_param sp;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
if(number){
onum = number;
}
else {
if(s = config.findValue("ModuleControllerNumber:"))
onum = s.retInt();
}
if(config.findValue("SimulateFpga:").retInt() == 1)
osimulate = 1;
else
osimulate = 0;
s = config.findValue("SimulateTiming:");
if(s != "")
osimulateTiming = s.retInt();
else
osimulateTiming = 0;
if(s = config.findValue("TmsServer:"))
oserverName = s;
orings = config.findValue("Rings:").retInt();
if(orings == 0)
orings = 1;
otempInternalMax = config.findValue("TempInternalMax:").retDouble();
otempFpgaMax = config.findValue("TempFpgaMax:").retDouble();
// Set default priority to real-time for all of these threads
if(realTime){
// seteuid(0);
sp.sched_priority = 25;
if(sched_setscheduler(0, SCHED_RR, &sp))
fprintf(stderr, "Warning: unable to set as real-time process\n");
}
// Initialise sub systems
otimer.start();
// Setup watchdog timer, if available
if(s = config.findValue("Watchdog:")){
int v = s.retInt();
if(v){
if((owatchdog = open("/dev/watchdog", O_RDWR)) >= 0){
ioctl(owatchdog, WDIOC_SETTIMEOUT, &v);
v = 0;
ioctl(owatchdog, WDIOC_SETPRETIMEOUT, &v);
}
}
}
opuControlServer.setName(BString("puControl-") + onum);
opuProcessServer.setName(BString("puProcess-") + onum);
if(err = oboapServer.init(oserverName, BoapServer::THREADED)){
return mergeError(err);
}
#ifdef ZAP
if(realTime){
// Set priority back to normal
sp.sched_priority = 0;
if(sched_setscheduler(0, SCHED_OTHER, &sp))
fprintf(stderr, "Warning: unable to set as normal process\n");
seteuid(getuid());
}
#endif
err = initCmd();
return err;
}
void Control::abort(){
// Disable watchdog
if(owatchdog >= 0){
write(owatchdog, "V", 1);
close(owatchdog);
}
}
BError Control::initCmd(){
BError err;
BIter i;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
olock.lock();
memset(oinitialised, 0, sizeof(oinitialised));
opupeEnginesLock.wrLock();
for(opupeEngines.start(i); !opupeEngines.isEnd(i); ){
delete opupeEngines[i];
opupeEngines.del(i);
}
opupeEnginesLock.unlock();
if(err = initPupeEngines()){
olock.unlock();
return err;
}
nprintf("%d Pupe Engines initialised\n", opupeEngines.number());
olock.unlock();
// Setup default parameters
setNextCycle(0, "Beam3");
dprintf(DBG_CMD, "%s: End\n", __PRETTY_FUNCTION__);
return err;
}
BError Control::setProcessPriority(BUInt32 priority){
BError err;
struct sched_param sp;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
if(realTime){
sp.sched_priority = 26;
if(sched_setscheduler(0, SCHED_RR, &sp))
fprintf(stderr, "Warning: unable to set as real-time process\n");
}
return err;
}
BError Control::configure(BUInt32 ring, ConfigInfo configInfo){
BError err;
dprintf(DBG_CMD, "%s: Ring: %d\n", __PRETTY_FUNCTION__, ring);
if((ring < 1) || (ring > 4))
return err.set(ErrorParam, "Ring value out of range");
oconfigInfoLock.lock();
oconfigInfo[ring - 1] = configInfo;
oconfigInfoLock.unlock();
oinitialised[ring - 1] = 1;
return err;
}
BError Control::test(BList<BError>& errors){
BError errRet;
BError err;
BIter i;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
opupeEnginesLock.rdLock();
for(opupeEngines.start(i); !opupeEngines.isEnd(i); opupeEngines.next(i)){
if(err = opupeEngines[i]->status()){
errors.append(BError(err.getErrorNo(), getName() + "Pupe" + opupeEngines[i]->getSlot() + ": Status: " + err.getErrorNo() + " " + err.getString()));
}
else {
errors.append(BError(0, getName() + "Pupe" + opupeEngines[i]->getSlot() + ": Status: " + "Ok"));
}
}
opupeEnginesLock.unlock();
return errRet;
}
BError Control::getStatus(BList<NameValue>& statusList){
BError err;
BError e;
int numPupe = 0;
BIter i;
BString s;
int p;
BList<NameValue> l;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
opupeEnginesLock.rdLock();
#ifdef ZAP
for(opupeEngines.start(i), p = 1; !opupeEngines.isEnd(i); opupeEngines.next(i), p++){
e = opupeEngines[i]->status();
s = BString(e.getErrorNo()) + ",\"" + e.getString() + "\"";
statusList.append(NameValue(BString("TmsPuServer") + onum + "_Pupe" + p + "_Error", s));
if(!e){
numPupe++;
}
}
#else
for(opupeEngines.start(i), p = 1; !opupeEngines.isEnd(i); opupeEngines.next(i), p++){
e = opupeEngines[i]->status();
if(!e){
numPupe++;
}
opupeEngines[i]->getStatusList(PuChannel(1,1,1), statusList);
// statusList = statusList + l;
}
#endif
opupeEnginesLock.unlock();
olock.lock();
statusList.append(NameValue(BString("Module") + moduleNum() + "_Running", "1"));
statusList.append(NameValue(BString("Module") + moduleNum() + "_NumberPupe", numPupe));
statusList.append(NameValue(BString("Module") + moduleNum() + "_CycleNumber", ocycleNumber));
statusList.append(NameValue(BString("Module") + moduleNum() + "_CycleType", ocycleType));
olock.unlock();
return err;
}
BError Control::getStatistics(BList<NameValue>& statsList){
BError err;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
statsList.append(NameValue(BString("Module") + moduleNum() + "_UpTime", getTime() - ostartTime));
statsList.append(NameValue(BString("Module") + moduleNum() + "_CycleNumProcessed", ocycleProcessed));
return err;
}
BError Control::getMasterPuChannel(PuChannel& puChannel){
BError err;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
puChannel.moduleNum = onum;
puChannel.pupeNum = omaster + 1;
puChannel.pupeChan = 1;
return err;
}
BError Control::addEventServer(BString name){
BError err;
dprintf(DBG_CMD, "%s: %s\n", __PRETTY_FUNCTION__, name.retStr());
oeventServers.append(name);
return err;
}
BError Control::delEventServer(BString name){
BError err;
BIter i;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
oeventServers.del(name);
return err;
}
BError Control::setControlInfo(CycleParam params){
BError err;
BIter i;
BIter i1, i2;
int found = 0;
int done = 0;
dprintf(DBG_CMD, "Control::setControlInfo: %s %s\n", params.cycleType.retStr(), params.name.retStr());
ocycleParmsLock.lock();
// Check if there is already an entry for this cycleType
for(ocycleParms.start(i1); !ocycleParms.isEnd(i1); ocycleParms.next(i1)){
if(ocycleParms[i1].cycleType == params.cycleType){
found = 1;
break;
}
}
if(found){
// See if there is an entry for this ring and channel
found = 0;
for(ocycleParms[i1].params.start(i2); !ocycleParms[i1].params.isEnd(i2); ocycleParms[i1].params.next(i2)){
if((ocycleParms[i1].params[i2].ring == params.ring) && (ocycleParms[i1].params[i2].channel == params.channel)){
found = 1;
break;
}
}
// ZAP Needs some work. Neet to make sure ring0 is first, then channel0 next etc
if(found){
ocycleParms[i1].params[i2] = params;
}
else {
for(ocycleParms[i1].params.start(i2); !done && !ocycleParms[i1].params.isEnd(i2); ocycleParms[i1].params.next(i2)){
if(params.ring < ocycleParms[i1].params[i2].ring){
ocycleParms[i1].params.insert(i2, params);
done = 1;
}
else if(params.channel < ocycleParms[i1].params[i2].channel){
ocycleParms[i1].params.insert(i2, params);
done = 1;
}
}
if(!done)
ocycleParms[i1].params.append(params);
}
}
else {
ocycleParms.append(CycleParams(params.cycleType, params));
}
#ifdef ZAP
printf("CycleTypes:\n");
for(ocycleParms.start(i); !ocycleParms.isEnd(i); ocycleParms.next(i)){
printf("%s\n", ocycleParms[i].cycleType.retStr());
}
#endif
ocycleParmsLock.unlock();
return err;
}
BError Control::setNextCycle(UInt32 cycleNumber, BString cycleType){
BError err;
BIter i;
BIter i1, i2;
BUInt c;
PuChannel puChannel;
int found = 0;
int afterCycleStop = 0;
double ts, te;
static double tmax;
dprintf(DBG_SETNEXTCYCLE, "%s %u %s\n", __PRETTY_FUNCTION__, cycleNumber, cycleType.retStr());
ts = getTime();
olock.lock();
if(!oprocessingCycle)
afterCycleStop = 1;
ocycleNumberNext = cycleNumber;
ocycleTypeNext = cycleType;
// Could improve this with a hashed name lookup
ocycleParmsLock.lock();
for(ocycleParms.start(i1); !ocycleParms.isEnd(i1); ocycleParms.next(i1)){
dprintf(DBG_SETNEXTCYCLE, "Control::setNextCycle: CheckCycleType: %s - %s\n", ocycleParms[i1].cycleType.retStr(), cycleType.retStr());
if(ocycleParms[i1].cycleType == cycleType){
found = 1;
for(ocycleParms[i1].params.start(i2); !ocycleParms[i1].params.isEnd(i2); ocycleParms[i1].params.next(i2)){
if(ocycleParms[i1].params[i2].ring > 4){
ocycleParmsLock.unlock();
olock.unlock();
return err.set(ErrorParam, BString("State table ring number is out of range for CycleType: ") + cycleType);
}
if(ocycleParms[i1].params[i2].ring == 0){
if(ocycleParms[i1].params[i2].channel == 0){
puChannel = PuChannel(0, 0, 0);
opupeEnginesLock.rdLock();
for(opupeEngines.start(i); !opupeEngines.isEnd(i); opupeEngines.next(i)){
opupeEngines[i]->setNextCycle(puChannel, cycleNumber, cycleType, ocycleParms[i1].params[i2]);
}
opupeEnginesLock.unlock();
}
else {
ocycleParmsLock.unlock();
olock.unlock();
return err.set(ErrorParam, "State tables with channel number also need ring number");
}
}
else {
if(ocycleParms[i1].params[i2].channel == 0){
for(c = 0; c < oconfigInfo[ocycleParms[i1].params[i2].ring - 1].puReferences.size(); c++){
getPuPhysChannel(ocycleParms[i1].params[i2].ring, c + 1, puChannel);
opupeEnginesLock.rdLock();
if(puChannel.pupeNum > opupeEngines.number()){
err.set(ErrorParam, getName() + "No Pupe Engine Numbered: " + puChannel.pupeNum);
opupeEnginesLock.unlock();
ocycleParmsLock.unlock();
olock.unlock();
return err;
}
opupeEngines[puChannel.pupeNum - 1]->setNextCycle(puChannel, cycleNumber, cycleType, ocycleParms[i1].params[i2]);
opupeEnginesLock.unlock();
}
}
else {
getPuPhysChannel(ocycleParms[i1].params[i2].ring, ocycleParms[i1].params[i2].channel, puChannel);
opupeEnginesLock.rdLock();
if(puChannel.pupeNum > opupeEngines.number()){
err.set(ErrorParam, getName() + "No Pupe Engine Numbered: " + puChannel.pupeNum);
opupeEnginesLock.unlock();
ocycleParmsLock.unlock();
olock.unlock();
return err;
}
opupeEngines[puChannel.pupeNum - 1]->setNextCycle(puChannel, cycleNumber, cycleType, ocycleParms[i1].params[i2]);
opupeEnginesLock.unlock();
}
}
}
break;
}
}
ocycleParmsLock.unlock();
olock.unlock();
if(!found)
err.set(ErrorParam, BString("There are no Cycle Parameters for cycle type: ") + cycleType);
if(!err && afterCycleStop){
if(oprocessingCycle){
err.set(ErrorCycleNumber, getName() + "The next cycle has already started");
}
}
dprintf(DBG_SETNEXTCYCLE, "Tick: %d\n", ocycleTick);
// Synchronise Module controllers if in simulation mode
if(osimulate)
ocycleTick = 10;
if(osimulateTiming & TimingSigCycleStart){
// Make sure timing simulation is in sync between multiple TmsPuServers when CYCLE_START is simulated
otimer.sync();
if(ocycleTick == 9){
otimer.tick();
}
else {
ocycleTick = 10;
}
}
te = getTime();
if((te - ts) > tmax){
tmax = te - ts;
}
dprintf(DBG_SETNEXTCYCLE, "Control::setNextCycle: Time: %f MaxTime: %f\n", te - ts, tmax);
dprintf(DBG_SETNEXTCYCLE, "%s: End\n", __PRETTY_FUNCTION__);
return err;
}
BError Control::getStatus(PuChannel puChannel, PuStatus& puStatus){
BError err;
BIter i;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
opupeEnginesLock.rdLock();
if(puChannel.pupeNum == 0){
for(opupeEngines.start(i); !opupeEngines.isEnd(i); opupeEngines.next(i)){
opupeEngines[i]->getStatus(puChannel, puStatus);
}
}
else {
if(puChannel.pupeNum > opupeEngines.number()){
err.set(ErrorParam, getName() + "No Pupe Engine Numbered: " + opupeEngines.number());
}
else {
opupeEngines[puChannel.pupeNum - 1]->getStatus(puChannel, puStatus);
}
}
opupeEnginesLock.unlock();
return err;
}
BError Control::getCycleInformation(UInt32 cycleNumber, CycleInformation& cycleInformation){
BError err;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
opupeEnginesLock.rdLock();
err = mergeError(opupeEngines[0]->getCycleInformation(cycleNumber, cycleInformation));
opupeEnginesLock.unlock();
return err;
}
BError Control::getData(PuChannel puChannel, DataInfo dataInfo, Data& data, UInt32& orbitNumber){
BError err;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
// Setup for error return
data.numValues = 0;
data.dataType = 0;
data.numBunches = 0;
data.numChannels = 0;
opupeEnginesLock.rdLock();
#if SINGLE_DMA
opupeLock.lock();
#endif
if((puChannel.pupeNum < 1) || (puChannel.pupeNum > opupeEngines.number())){
#if SINGLE_DMA
opupeLock.unlock();
#endif
opupeEnginesLock.unlock();
return err.set(ErrorParam, getName() + "PuChannel: PupeNum out of range");
}
err = mergeError(opupeEngines[puChannel.pupeNum - 1]->getData(puChannel, dataInfo, data, orbitNumber));
#if SINGLE_DMA
opupeLock.unlock();
#endif
opupeEnginesLock.unlock();
return err;
}
BError Control::requestData(PuChannel puChannel, DataInfo dataInfo){
BError err;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
return err;
}
BError Control::setTestMode(PuChannel puChannel, UInt32 testOutput, UInt32 timingDisableMask){
BError err;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
opupeEnginesLock.rdLock();
if((puChannel.pupeNum < 1) || (puChannel.pupeNum > opupeEngines.number())){
opupeEnginesLock.unlock();
return err.set(ErrorMisc, getName() + "PuChannel: PupeNum out of range");
}
err = mergeError(opupeEngines[puChannel.pupeNum - 1]->setTestMode(puChannel, testOutput, timingDisableMask));
opupeEnginesLock.unlock();
return err;
}
BError Control::setTimingSignals(PuChannel puChannel, UInt32 timingSignals){
BError err;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
opupeEnginesLock.rdLock();
if((puChannel.pupeNum < 1) || (puChannel.pupeNum > opupeEngines.number())){
opupeEnginesLock.unlock();
return err.set(ErrorMisc, getName() + "PuChannel: PupeNum out of range");
}
err = mergeError(opupeEngines[puChannel.pupeNum - 1]->setTimingSignals(puChannel, timingSignals));
opupeEnginesLock.unlock();
return err;
}
BError Control::captureDiagnostics(PuChannel puChannel, TestCaptureInfo captureInfo, BArray<UInt64>& data){
BError err;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
opupeEnginesLock.rdLock();
if((puChannel.pupeNum < 1) || (puChannel.pupeNum > opupeEngines.number())){
opupeEnginesLock.unlock();
return err.set(ErrorMisc, getName() + "PuChannel: PupeNum out of range");
}
printf("Control::captureDiagnostics: call pupe\n");
err = mergeError(opupeEngines[puChannel.pupeNum - 1]->captureDiagnostics(puChannel, captureInfo, data));
opupeEnginesLock.unlock();
dprintf(DBG_CMD, "%s: End\n", __PRETTY_FUNCTION__);
return err;
}
BError Control::setTestData(PuChannel puChannel, Int32 on, BArray<UInt32> data){
BError err;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
opupeEnginesLock.rdLock();
if((puChannel.pupeNum < 1) || (puChannel.pupeNum > opupeEngines.number())){
opupeEnginesLock.unlock();
return err.set(ErrorMisc, getName() + "PuChannel: PupeNum out of range");
}
err = mergeError(opupeEngines[puChannel.pupeNum - 1]->setTestData(puChannel, on, data));
opupeEnginesLock.unlock();
dprintf(DBG_CMD, "%s: End\n", __PRETTY_FUNCTION__);
return err;
}
BError Control::setPupeConfig(PuChannel puChannel, PupeConfig pupeConfig){
BError err;
dprintf(DBG_CMD, "%s\n", __PRETTY_FUNCTION__);
opupeEnginesLock.rdLock();
if((puChannel.pupeNum < 1) || (puChannel.pupeNum > opupeEngines.number())){
opupeEnginesLock.unlock();
return err.set(ErrorMisc, getName() + "PuChannel: PupeNum out of range");
}
err = mergeError(opupeEngines[puChannel.pupeNum - 1]->setPupeConfig(puChannel, pupeConfig));
osimulateTiming = pupeConfig.internalTimingMask;
opupeEnginesLock.unlock();
return err;
}
BError Control::getPupeConfig(PuChannel puChannel, PupeConfig& pupeConfig){
BError err;
dprintf(DBG_CMD, "Control::getPupeConfig: %d.%d.%d\n", puChannel.moduleNum, puChannel.pupeNum, puChannel.pupeChan);
opupeEnginesLock.rdLock();
if((puChannel.pupeNum < 1) || (puChannel.pupeNum > opupeEngines.number())){
opupeEnginesLock.unlock();
return err.set(ErrorMisc, getName() + "PuChannel: PupeNum out of range");
}
err = mergeError(opupeEngines[puChannel.pupeNum - 1]->getPupeConfig(puChannel, pupeConfig));
opupeEnginesLock.unlock();
return err;
}
void Control::run(){
dprintf(DBG_CMD, "Control::run\n");
oboapServer.run();
}
void Control::timer(){
static uint32_t tick = 0;
static int simEnable = 0;
BError err;
BIter i;
// printf("Control::timer: %d\n", ocycleTick);
if(simEnable){
if(++ocycleTick >= 12)
ocycleTick = 0;
//printf("CycleTick: %d\n", ocycleTick);
if(osimulate){
opupeEnginesLock.rdLock();
if(ocycleTick == 0){
for(opupeEngines.start(i); !opupeEngines.isEnd(i); opupeEngines.next(i))
opupeEngines[i]->cycleStart();
}
else if(ocycleTick == 4){
if(opupeEngines.number())
opupeEngines.front()->fpgaTriggerTimingInputs(TimingSigInjection);
}
else if(ocycleTick == 6){
if(opupeEngines.number())
opupeEngines.front()->fpgaTriggerTimingInputs(TimingSigHChange);
}
else if(ocycleTick == 10){
for(opupeEngines.start(i); !opupeEngines.isEnd(i); opupeEngines.next(i))
opupeEngines[i]->cycleStop();
}
opupeEnginesLock.unlock();
}
else {
opupeEnginesLock.rdLock();
if((osimulateTiming & TimingSigCycleStart) && (ocycleTick == 0)){
if(opupeEngines.number())
opupeEngines[omaster]->fpgaTriggerTimingInputs(TimingSigCycleStart);
}
else if((osimulateTiming & TimingSigInjection) && (ocycleTick == 4)){
if(opupeEngines.number())
opupeEngines[omaster]->fpgaTriggerTimingInputs(TimingSigInjection);
}
else if((osimulateTiming & TimingSigHChange) && (ocycleTick == 6)){
if(opupeEngines.number())
opupeEngines[omaster]->fpgaTriggerTimingInputs(TimingSigHChange);
}
else if((osimulateTiming & TimingSigCycleStop) && (ocycleTick == 10)){
if(opupeEngines.number())
opupeEngines[omaster]->fpgaTriggerTimingInputs(TimingSigCycleStop);
}
opupeEnginesLock.unlock();
}
}
if(tick == 30){
simEnable = 1;
}
// Every 1 seconds do some house keeping
if((tick % 10) == 9){
int r;
for(r = 0; r < orings; r++){
TmsControl tmsControl(BString("//") + oserverName + "/tmsControl" + (r + 1));
if(!oinitialised[r]){
if(err = tmsControl.puServerStarted(onum)){
wprintf("Unable to call puServerStarted on %s: for ring: %d %s\n", oserverName.retStr(), r, err.getString().retStr());
}
}
}
// Check ADC Pll Locks
opupeEnginesLock.rdLock();
for(opupeEngines.start(i); !opupeEngines.isEnd(i); opupeEngines.next(i)){
opupeEngines[i]->adcPllLockCheck();
}
opupeEnginesLock.unlock();
// Ping the watchdog
if(owatchdog >= 0){
ioctl(owatchdog, WDIOC_KEEPALIVE, 0);
}
}
// Every 10 seconds do some house keeping
if((tick % 100) == 99){
double tempInternal = 0.0;
double tempFpga = 0.0;
// Check Temperatures
opupeEnginesLock.rdLock();
for(opupeEngines.start(i); !opupeEngines.isEnd(i); opupeEngines.next(i)){
opupeEngines[i]->getTemperatures(tempInternal, tempFpga);
if(otempInternalMax && (tempInternal > otempInternalMax)){
opupeEngines[i]->setStatus(BError(ErrorFpga, "Temperature Internal to high: FPGA shutdown"), 1);
wprintf("Temperature Internal to high on %s: FPGA shutdown\n", (getName() + opupeEngines[i]->getName().retStr()).retStr());
}
if(otempFpgaMax && (tempFpga > otempFpgaMax)){
opupeEngines[i]->setStatus(BError(ErrorFpga, "Temperature Fpga to high: FPGA shutdown"), 1);
wprintf("Temperature FPGA to high on %s: FPGA shutdown\n", (getName() + opupeEngines[i]->getName().retStr()).retStr());
}
}
opupeEnginesLock.unlock();
}
tick++;
}
void Control::cycleStart(UInt32 cycleNumber){
BError err;
dprintf(DBG_CYCLE, "Control::cycleStart\n");
olock.lock();
oprocessingCycle = 1;
ocycleNumber = ocycleNumberNext;
ocycleType = ocycleTypeNext;
#ifdef ZAP
// Make sure timing simulation is in sync with cycle start
otimer.sync();
ocycleTick = 0;
#endif
olock.unlock();
if(onum == 1){
if(err = oeventServers.cycleStartEvent(cycleNumber))
wprintf(getName() + "Error send CycleStart event: " + err.getString() + "\n");
}
}
void Control::cycleError(UInt32 cycleNumber, BError error){
dprintf(DBG_CYCLE, "Control::cycleError\n");
olock.lock();
oeventServers.errorEvent(cycleNumber, error);
eprintf(getName() + "Control::cycleError: Cycle: %d Error: %s\n", cycleNumber, error.getString().retStr());
olock.unlock();
}
void Control::cycleStop(UInt32 cycleNumber){
dprintf(DBG_CYCLE, "Control::cycleStop\n");
olock.lock();
ocycleProcessed++;
oprocessingCycle = 0;
// printf("Control::cycleStop: %u CurrentCycleType: %s NextCycleType: %s\n", cycleNumber, ocycleType.retStr(), ocycleTypeNext.retStr());
olock.unlock();
if(onum == 1){
oeventServers.cycleStopEvent(cycleNumber);
}
}
BError Control::initPupeEngines(){
BError err;
BError e;
int physical = 0;
int slot = 0;
int board;
Pupe* pupe;
BArray<int> devs;
int d = 0;
BString str;
BString s;
int numBoards = 5;
if((s = config.findValue("PupeNumber:")) != ""){
numBoards = config.findValue("PupeNumber:").retInt();
}
if((s = config.findValue("PupeMaster:")) != ""){
omaster = config.findValue("PupeMaster:").retInt() - 1;
}
if(config.findValue("PupePhysicalOn:").retInt() == 1){
str = config.findValue("PupePhysicalDevices:");
while((s = str.pullToken(",")) != ""){
devs.resize(d + 1);
devs[d] = s.retInt();
d++;
}
if(err = opupeGeog.scan(devs))
return err;
physical = 1;
}
opupeEnginesLock.wrLock();
for(slot = 0; slot < numBoards; slot++){
if(!osimulate && physical)
board = opupeGeog.getBoardId(slot);
else
board = slot;
if(board < 0){
wprintf(getName() + "PupeEngine no board in slot: " + slot + "\n");
}
pupe = new Pupe(*this, slot, board);
opupeEngines.append(pupe);
if(e = pupe->init()){
wprintf(getName() + "PupeEngine init error: " + e.getString() + "\n");
}
if(omaster == slot)
pupe->setMaster(1);
else
pupe->setMaster(0);
}
opupeEnginesLock.unlock();
return err;
}
BError Control::getPuChannel(PuChannel puPhysChannel, UInt32& ring, UInt32& puChannel){
BError err;
BUInt r;
BUInt i;
// Could use a mapping table to speed this up if necessary
oconfigInfoLock.lock();
ring = 0;
puChannel = 0;
for(r = 0; r < 4; r++){
for(i = 0; i < oconfigInfo[r].puReferences.size(); i++){
if((puPhysChannel.moduleNum == oconfigInfo[r].puReferences[i].moduleNum) &&
(puPhysChannel.pupeNum == oconfigInfo[r].puReferences[i].pupeNum) &&
(puPhysChannel.pupeChan == oconfigInfo[r].puReferences[i].pupeChan)){
ring = r + 1;
puChannel = i + 1;
oconfigInfoLock.unlock();
return err;
}
}
}
oconfigInfoLock.unlock();
return err.set(ErrorParam, getName() + "Physical PuChannel not configured");
}
BError Control::getPuPhysChannel(UInt32 ring, UInt32 puChannel, PuChannel& puPhysChannel){
BError err;
if((ring < 1) || (ring > 4))
return err.set(ErrorParam, "Ring value out of range");
oconfigInfoLock.lock();
if((puChannel < 1) || (puChannel > oconfigInfo[ring - 1].puReferences.size())){
oconfigInfoLock.unlock();
return err.set(ErrorParam, getName() + "Physical PuChannel not configured");
}
puPhysChannel = oconfigInfo[ring - 1].puReferences[puChannel - 1];
oconfigInfoLock.unlock();
return err;
}
int Control::moduleNum(){
return onum;
}
