entermonitor.cpp

来自「一个很棒的网络控制系统仿真软件」· C++ 代码 · 共 43 行

#ifndef ENTER_MONITOR
#define ENTER_MONITOR

void ttEnterMonitor(char *nameOfMonitor) {
  
  MonitorNode* mn;
  TaskNode* tn;
  Monitor* mon;
  
  mn = (MonitorNode*) rtsys->monitorList->getFirst();
  while (mn != NULL) {
    mon = mn->getMonitor();
    if (mon->name != NULL) {
      if (strcmp(mon->name, nameOfMonitor) == 0)
	break;
    }
    mn = (MonitorNode*) mn->getNext();
  }

  if (mn == NULL) {
    // Monitor does not exist 
    char buf[200];
    sprintf(buf, "ttEnterMonitor: Non-existent monitor '%s'!", nameOfMonitor);
    MEX_ERROR(buf);
    return;
  }

  mon = mn->getMonitor();
  if (mon->heldBy == NULL) { // Free 
    mon->heldBy = rtsys->executing;
  }
  else { // Not free 
    mon->waitingQ->appendNode(new TaskNode(rtsys->executing));
    tn = (TaskNode*) rtsys->readyQ->getLast();
    rtsys->readyQ->deleteNode(tn);
    // Priority Inheritance 
    if (mon->heldBy->priority > rtsys->executing->priority) 
      mon->heldBy->priority = rtsys->executing->priority;
  }
}

#endif