Subversion Repositories openrisc_me

/* Cache code for SPARClite
 *
 * Copyright (c) 1998 Cygnus Support
 *
 * The authors hereby grant permission to use, copy, modify, distribute,
 * and license this software and its documentation for any purpose, provided
 * that existing copyright notices are retained in all copies and that this
 * notice is included verbatim in any distributions. No written agreement,
 * license, or royalty fee is required for any of the authorized uses.
 * Modifications to this software may be copyrighted by their authors
 * and need not follow the licensing terms described here, provided that
 * the new terms are clearly indicated on the first page of each file where
 * they apply.
 */
 
#include "sparclite.h"
 
/* Ancillary registers on the DANlite */
 
#define DIAG 30
#define ICCR 31
 
/* Bits in the DIAG register */
 
#define ICD 0x40000000		/* ICACHE disable */
#define DCD 0x20000000		/* DCACHE disable */
 
/* Bits in the ICCR register */
 
#define CE 1			/* cache enable*/
 
 
/* Forward declarations. */
 
void flush_i_cache ();
 
 
/* Determine if this is a DANlite (MB8686x), as opposed to an earlier
   SPARClite (MB8683x).  This is done by examining the impl and ver
   fields in the PSR:
 
   MB8683x: impl(bit31-28)=0x0; ver(bit27-24)=0xf;
   MB8686x: impl(bit31-28)=0x1; ver(bit27-24)=0xe;
*/
 
static int
is_danlite ()
{
  static int checked = 0;
  static int danlite = 0;
 
  if (!checked)
    {
      int psr = read_psr ();
      danlite = (psr & 0xff000000) == 0x1e000000;
      checked = 1;
    }
  return danlite;
}
 
/* This cache code is known to work on both the 930 & 932 processors.  It just
   cheats and clears the all of the address space that could contain tags, as
   opposed to striding the tags at 8 or 16 word intervals, or using the cache
   flush registers, which don't exist on all processors.  */
 
void
cache_off ()
{
  if (is_danlite ())
    {
      /* Disable the ICACHE.  Disabling the DCACHE crashes the machine. */
      unsigned int diag = read_asr (DIAG);
      write_asr (DIAG, diag | ICD);
    }
  else
    {
      write_asi (1, 0, 0);
    }
}
 
void
cache_on ()
{
  if (is_danlite ())
    {
      unsigned int diag;
 
      /* Flush the caches. */
      flush_i_cache ();
 
      /* Enable the ICACHE and DCACHE */
      diag = read_asr (DIAG);
      write_asr (DIAG, diag & ~ (ICD | DCD));
    }
  else
    {
      unsigned long addr;
 
      cache_off ();			/* Make sure the cache is off */
 
      /* Reset all of the cache line valid bits */
 
      for (addr = 0; addr < 0x1000; addr += 8)
	{
	  write_asi (0xc, addr, 0);	/* Clear bank 1, icache */
	  write_asi (0xc, addr + 0x80000000, 0); /* Clear bank 2, icache */
 
	  write_asi (0xe, addr, 0);	/* Clear bank 1, dcache */
	  write_asi (0xe, addr + 0x80000000, 0); /* Clear bank 2, dcache */
	}
 
      /* turn on the cache */
 
      write_asi (1, 0, 0x35);	/* Write buf ena, prefetch buf ena, data
				       & inst caches enab */
    }
}
 
/* Flush the instruction cache.  We need to do this for the debugger stub so
   that breakpoints, et. al. become visible to the instruction stream after
   storing them in memory.
 */
 
void
flush_i_cache ()
{
  if (is_danlite ())
    {
      write_asi (0x31, 0, 0);	/* Flush entire i/d caches */
    }
  else
    {
      int cache_reg;
      unsigned long addr;
 
      cache_reg = read_asi (1, 0);	/* Read cache/bus interface reg */
 
      if (!(cache_reg & 1))
	return;			/* Just return if cache is already off */
 
      for (addr = 0; addr < 0x1000; addr += 8)
	{
	  write_asi (0xc, addr, 0);	/* Clear bank 1, icache */
	  write_asi (0xc, addr + 0x80000000, 0); /* Clear bank 2, icache */
	}
    }
}