3 * CP15 (system control) is the one that gets used the most in practice.
6 #include "../port/lib.h"
14 #define MAP2PCSPACE(va, pc) ((uintptr)(va) & ~KSEGM | (pc) & KSEGM)
17 /* alternates: 0xe12fff1e BX (R14); last e is R14 */
18 /* 0xe28ef000 B 0(R14); second e is R14 (ken) */
19 Retinst = 0xe1a0f00e, /* MOVW R14, R15 */
21 Fpproc = 10, /* for vfp 3+; also 11 for doubles */
25 cpwr(int cp, int op1, int crn, int crm, int op2, ulong val)
28 volatile ulong instr[2];
38 /* MCR. Rt will be R0. */
39 instr[0] = 0xee000010 |
40 op1 << 21 | crn << 16 | cp << 8 | op2 << 5 | crm;
44 pcaddr = (void *)MAP2PCSPACE(instr, getcallerpc(&cp));
45 cachedwbse(pcaddr, sizeof instr);
48 fp = (void (*)(ulong))pcaddr;
55 cpwrsc(int op1, int crn, int crm, int op2, ulong val)
57 cpwr(CpSC, op1, crn, crm, op2, val);
61 cprd(int cp, int op1, int crn, int crm, int op2)
65 volatile ulong instr[2];
75 * MRC. return value will be in R0, which is convenient.
78 instr[0] = 0xee100010 |
79 op1 << 21 | crn << 16 | cp << 8 | op2 << 5 | crm;
83 pcaddr = (void *)MAP2PCSPACE(instr, getcallerpc(&cp));
84 cachedwbse(pcaddr, sizeof instr);
87 fp = (ulong (*)(void))pcaddr;
94 cprdsc(int op1, int crn, int crm, int op2)
96 return cprd(CpSC, op1, crn, crm, op2);
106 volatile ulong instr[2];
113 * VMRS. return value will be in R0, which is convenient.
116 instr[0] = 0xeef00010 | fpreg << 16 | 0 << 12 | Fpproc << 8;
120 pcaddr = (void *)MAP2PCSPACE(instr, getcallerpc(&fpreg));
121 cachedwbse(pcaddr, sizeof instr);
124 fp = (ulong (*)(void))pcaddr;
131 fpwr(int fpreg, ulong val)
134 volatile ulong instr[2];
140 /* VMSR. Rt will be R0. */
141 instr[0] = 0xeee00010 | fpreg << 16 | 0 << 12 | Fpproc << 8;
145 pcaddr = (void *)MAP2PCSPACE(instr, getcallerpc(&fpreg));
146 cachedwbse(pcaddr, sizeof instr);
149 fp = (void (*)(ulong))pcaddr;