summaryrefslogtreecommitdiff
path: root/gcc/config/mep/mep-tramp.c
blob: bf484ca4e95178112acdf0c828c56ad27045b02d (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
/* 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;
	}
    }
}