Initial commit of OpenSPARC T2 architecture model.

[OpenSPARC-T2-SAM] / sam-t2 / sam / cpus / vonk / ss / api / pli / src / SS_IrqSync.cc

// ========== Copyright Header Begin ==========================================
// 
// OpenSPARC T2 Processor File: SS_IrqSync.cc
// Copyright (c) 2006 Sun Microsystems, Inc.  All Rights Reserved.
// DO NOT ALTER OR REMOVE COPYRIGHT NOTICES.
// 
// The above named program is free software; you can redistribute it and/or
// modify it under the terms of the GNU General Public
// License version 2 as published by the Free Software Foundation.
// 
// The above named 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 work; if not, write to the Free Software
// Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA.
// 
// ========== Copyright Header End ============================================

#include <stdio.h>
#include "SS_IrqSync.h"

SS_IrqSync::SS_IrqSync( SS_Strand* s )/*{{{*/
 :
  strand(s),
  cur_time(0),
  head(0)
{
  // Plug this IrqSync into the Strand
 
  strand->irq_sync = this;
  strand->irq_store = &SS_IrqSync::store;
}
/*}}}*/
void SS_IrqSync::store( void* _irq_sync, SS_Trap::Type irq_type, bool do_time_out ) /*{{{*/
{
  SS_IrqSync* irq_sync = (SS_IrqSync*)_irq_sync;
 
  // Insert the new trap in the chain based on priority: highest priority is on the head,
  // If there are traps with same priority but different type we stick the last one at
  // the end: first come first serve.
 
  if (irq_type == SS_Trap::TRAP_LEVEL_ZERO)
    do_time_out = false;

  uint_t priority = SS_Trap::table[irq_type].priority;

  IrqInfo* here = irq_sync->head;

  if (here == 0 || priority < here->priority)
  {
    irq_sync->head = new IrqInfo(irq_type,priority,do_time_out ? (irq_sync->cur_time + SS_IrqSync::TIME_OUT) : 0,here);
  }
  else
  {
    IrqInfo* next = here->next;

    while (next && (priority >= next->priority))
    {
      // Allow the same interruppt to be stored more then once ... 
      // It makes life so much easier if we do this.
      if (here->irq_type == irq_type)
	return;
      
      here = next;
      next = here->next;
    }
  
    here->next = new IrqInfo(irq_type,priority,do_time_out ? (irq_sync->cur_time + SS_IrqSync::TIME_OUT) : 0,next);
  }
}
/*}}}*/
void SS_IrqSync::raise( SS_Trap::Type irq_type )/*{{{*/
{
  // The DUT sends us a INTP tid tt=0 right at the beginning.
  // There is no point in that as when Vonk is created the
  // cpu/core/strand state has already been through a reset.

  if (irq_type == 0)
    return;
  
  for (IrqInfo* here = head; here; here = here->next)
  {
    if (here->irq_type == irq_type)
    {
      here->time_out = 0;
      return;
    }
  }
  
  // Don't complain about reset type traps.
  if ((irq_type >= SS_Trap::STORE_ERROR) && 
      (irq_type != SS_Trap::RESET_GEN_WMR))
    fprintf(stdout,"IRQ_SYNC: Trap tt=0x%x is raised unexpectedly\n",irq_type);

  store(this,irq_type,false);
}
/*}}}*/
bool SS_IrqSync::check_list()/*{{{*/
{
  IrqInfo* prev = head;
  IrqInfo* here = prev;

  while (here)
  {
    if (here->time_out == 0)
    {
      if (strand->trap_launch_ok(here->irq_type))
      {
	(strand->trap)(strand->pc(),strand->npc(),strand,0,here->irq_type);
	if (prev == here)
	  head = here->next;
	else
	  prev->next = here->next;
	delete here;
	return true;
      }
      else
      {
	prev = here;
	here = here->next;
      }
    }
    else if (here->time_out < cur_time)
    {
      fprintf(stdout,"IRQ_SYNC: Trap tt=0x%x timed out.\n",here->irq_type);
      if (prev == here)
      {
	head = here->next;
	delete here;
	prev = head;
	here = prev;
      }
      else
      {
	prev->next = here->next;
	delete here;
	here = prev->next;
      }
    }
    else
    {
      prev = here;
      here = here->next;
    }
  }
  return false;
}
/*}}}*/

void SS_IrqSync::clear_list()/*{{{*/
{
  IrqInfo* here = head;
  while (here)
  {
    IrqInfo* next = here->next;
    fprintf(stdout, "IRQ_SYNC: Trap tt=0x%x removed.\n", here->irq_type);
    delete here;
    here = next;
  }
  head = 0;
}
/*}}}*/