Subversion Repositories openrisc_me

/* Trampoline support for MeP
   Copyright (C) 2004, 2007 Free Software Foundation, Inc.
   Contributed by Red Hat Inc.
 
This file 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 3 of the License, or (at your
option) any later version.
 
This file 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.
 
Under Section 7 of GPL version 3, you are granted additional
permissions described in the GCC Runtime Library Exception, version
3.1, as published by the Free Software Foundation.
 
You should have received a copy of the GNU General Public License and
a copy of the GCC Runtime Library Exception along with this program;
see the files COPYING3 and COPYING.RUNTIME respectively.  If not, see
<http://www.gnu.org/licenses/>.  */
 
/*
  7a0a		ldc $10,$pc
  c0ae000a	lw $0,10($10)
  caae000e	lw $10,14($10)
  10ae		jmp $10
  00000000	static chain
  00000000	function address
*/
 
static inline int
cache_config_register(void) {
  int rv;
  asm ("ldc\t%0, $ccfg" : "=r" (rv));
  return rv;
}
 
#define ICACHE_SIZE ((cache_config_register() >> 16) & 0x7f)
#define DCACHE_SIZE (cache_config_register() & 0x7f)
 
#define ICACHE_DATA_BASE 0x00300000
#define ICACHE_TAG_BASE  0x00310000
#define DCACHE_DATA_BASE 0x00320000
#define DCACHE_TAG_BASE  0x00330000
 
static inline void
flush_dcache (int addr)
{
  asm volatile ("cache\t0, (%0)" : : "r" (addr));
}
 
void
__mep_trampoline_helper (unsigned long *tramp,
			 int function_address,
			 int static_chain);
 
void
__mep_trampoline_helper (unsigned long *tramp,
			 int function_address,
			 int static_chain)
{
  int dsize, isize;
 
#ifdef __LITTLE_ENDIAN__
  tramp[0] = 0xc0ae7a0a;
  tramp[1] = 0xcaae000a;
  tramp[2] = 0x10ae000e;
#else
  tramp[0] = 0x7a0ac0ae;
  tramp[1] = 0x000acaae;
  tramp[2] = 0x000e10ae;
#endif
  tramp[3] = static_chain;
  tramp[4] = function_address;
 
  dsize = DCACHE_SIZE;
  isize = ICACHE_SIZE;
 
  if (dsize)
    {
      flush_dcache ((int)tramp);
      flush_dcache ((int)tramp+16);
    }
 
  if (isize)
    {
      int imask = (isize * 1024) - 1;
      int tmask = ~imask;
      unsigned int i;
      volatile unsigned int *tags;
 
      imask &= 0xffe0;
 
      for (i=(unsigned int)tramp; i<(unsigned int)tramp+20; i+=16)
	{
	  tags = (unsigned int *)(ICACHE_TAG_BASE + (i & imask));
	  if ((*tags & tmask) == (i & tmask))
	    *tags &= ~1;
	}
    }
}