/* Trampoline support for MeP
   Copyright (C) 2004-2014 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;
	}
    }
}