Subversion Repositories or1k

/* sched.c -- Abstract entities, handling job scheduling
   Copyright (C) 2001 Marko Mlinar, markom@opencores.org
 
This file is part of OpenRISC 1000 Architectural Simulator.
 
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 2 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, write to the Free Software
Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. */
 
/* Abstract memory and routines that go with this. I need to
add all sorts of other abstract entities. Currently we have
only memory. */
 
#include <stdlib.h>
#include <stdio.h>
#include <ctype.h>
#include <string.h>
#include <limits.h>
 
#include "config.h"
 
#ifdef HAVE_INTTYPES_H
#include <inttypes.h>
#endif
 
#include "port.h"
#include "arch.h"
#include "sim-config.h"
#include "config.h"
#include "sched.h"
#include "debug.h"
 
DEFAULT_DEBUG_CHANNEL(sched);
DECLARE_DEBUG_CHANNEL(sched_jobs);
 
#define SCHED_HEAP_SIZE 128
#define SCHED_TIME_MAX  INT32_MAX
 
/* FIXME: Scheduler should continue from previous cycles not current ones */
 
struct scheduler_struct scheduler;
 
/* Dummy function, representing a guard, which protects heap from
   emptying */
void sched_guard (void *dat)
{
  if(scheduler.job_queue)
    SCHED_ADD(sched_guard, dat, SCHED_TIME_MAX);
  else {
    scheduler.job_queue = scheduler.free_job_queue;
    scheduler.free_job_queue = scheduler.free_job_queue->next;
    scheduler.job_queue->next = NULL;
    scheduler.job_queue->func = sched_guard;
    scheduler.job_queue->time = SCHED_TIME_MAX;
  }
}
 
void sched_reset(void)
{
  struct sched_entry *cur, *next;
 
  for(cur = scheduler.job_queue; cur; cur = next) {
    next = cur->next;
    cur->next = scheduler.free_job_queue;
    scheduler.free_job_queue = cur;
  }
  scheduler.job_queue = NULL;
  sched_guard(NULL);
}
 
void sched_init(void)
{
  int i;
  struct sched_entry *new;
 
  scheduler.free_job_queue = NULL;
 
  for(i = 0; i < SCHED_HEAP_SIZE; i++) {
    if(!(new = malloc(sizeof(struct sched_entry)))) {
      fprintf(stderr, "Out-of-memory while allocateing scheduler queue\n");
      exit(1);
    }
    new->next = scheduler.free_job_queue;
    scheduler.free_job_queue = new;
  }
  scheduler.job_queue = NULL;
  sched_guard(NULL);
}
 
static void sched_print_jobs(void)
{
  struct sched_entry *cur;
  int i;
 
  for (cur = scheduler.job_queue, i = 0; cur; cur = cur->next, i++)
    TRACE("\t%i: %p $%p @ %"PRIi32"\n", i, cur->func, cur->param, cur->time);
}
 
/* Adds new job to the queue */
void sched_add(void (*job_func)(void *), void *job_param, int32_t job_time,
               const char *func)
{
  struct sched_entry *cur, *prev, *new_job;
  int32_t alltime;
 
  TRACE("%s@%lli:SCHED_ADD(time %"PRIi32")\n", func, runtime.sim.cycles,
        job_time);
  if(TRACE_ON(sched_jobs)) {
    sched_print_jobs();
    TRACE("--------\n");
  }
 
  cur = scheduler.job_queue;
  prev = NULL;
  alltime = cur->time;
  while(cur && (alltime < job_time)) {
    prev = cur;
    cur = cur->next;
    if(cur)
      alltime += cur->time;
  }
 
  new_job = scheduler.free_job_queue;
  scheduler.free_job_queue = new_job->next;
  new_job->next = cur;
 
  new_job->func = job_func;
  new_job->param = job_param;
 
  if(prev) {
    new_job->time = job_time - (alltime - (cur ? cur->time : 0));
    prev->next = new_job;
    TRACE("Scheduled job not going to head of queue, relative time: %"
          PRIi32"\n", new_job->time);
  } else {
    scheduler.job_queue = new_job;
    new_job->time = job_time >= 0 ? job_time : cur->time;
    TRACE("Setting to-go cycles to %"PRIi32" at %lli\n", job_time,
          runtime.sim.cycles);
  }
 
  if(cur)
    cur->time -= new_job->time;
 
  if(TRACE_ON(sched_jobs))
    sched_print_jobs();
}
 
/* Returns a job with specified function and param, NULL if not found */
void sched_find_remove(void (*job_func)(void *), void *dat, const char *func)
{
  struct sched_entry *cur;
  struct sched_entry *prev = NULL;
 
  TRACE("%s@%lli:SCHED_REMOVE()\n", func, runtime.sim.cycles);
 
  for (cur = scheduler.job_queue; cur; prev = cur, cur = cur->next) {
    if ((cur->func == job_func) && (cur->param == dat)) {
      if(cur->next)
        cur->next->time += cur->time;
 
      if(prev)
        prev->next = cur->next;
      else
        scheduler.job_queue = cur->next;
      cur->next = scheduler.free_job_queue;
      scheduler.free_job_queue = cur;
      break;
    }
  }
}
 
/* Schedules the next job so that it will run after the next instruction */
void sched_next_insn(void (*func)(void *), void *dat)
{
  int32_t cycles = 1;
  struct sched_entry *cur = scheduler.job_queue;
 
  /* The cycles count of the jobs may go into negatives.  If this happens, func
   * will get called before the next instruction has executed. */
  while(cur && (cur->time < 0)) {
    cycles -= cur->time;
    cur = cur->next;
  }
 
  SCHED_ADD(func, dat, cycles);
}