blob: 1d892504ee7463b11bbdf7b3f4ea977dd16fcf2a (
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
|
/*
* ARMv8 system registers
* mainly to cope with arm hard-wiring register numbers into instructions.
*
* these routines must be callable from KZERO.
*
* on a multiprocessor, process switching to another cpu is assumed
* to be inhibited by the caller as these registers are local to the cpu.
*/
#include "u.h"
#include "../port/lib.h"
#include "mem.h"
#include "dat.h"
#include "fns.h"
static void*
mkinstr(ulong wd)
{
static ulong ib[256], *ep[MAXMACH+1];
static Lock lk;
ulong *ip, *ie;
ie = ep[m->machno];
for(ip = ib; ip < ie; ip += 2)
if(*ip == wd)
return ip;
ilock(&lk);
ie = ep[MAXMACH];
for(; ip < ie; ip += 2)
if(*ip == wd)
goto Found;
if(ip >= &ib[nelem(ib)])
panic("mkinstr: out of instrucuction buffer");
ip[0] = wd;
ip[1] = 0xd65f03c0; // RETURN
ep[MAXMACH] = ie = ip + 2;
cachedwbinvse(ip, 2*sizeof(*ip));
Found:
iunlock(&lk);
cacheiinv();
ep[m->machno] = ie;
return ip;
}
uvlong
sysrd(ulong spr)
{
uvlong (*fp)(void) = mkinstr(0xd5380000UL | spr);
return fp();
}
void
syswr(ulong spr, uvlong val)
{
void (*fp)(uvlong) = mkinstr(0xd5180000UL | spr);
fp(val);
}
|
