142 lines · 2.8 KB · C
RawDownload
/*  * This file is part of the UCB release of Plan 9. It is subject to the license * terms in the LICENSE file found in the top-level directory of this * distribution and at http://akaros.cs.berkeley.edu/files/Plan9License. No * part of the UCB release of Plan 9, including this file, may be copied, * modified, propagated, or distributed except according to the terms contained * in the LICENSE file. */ /* * arm co-processors * CP15 (system control) is the one that gets used the most in practice. */#include "u.h"#include "../port/lib.h"#include "mem.h"#include "dat.h"#include "fns.h"#include "io.h" #include "arm.h" #define MAP2PCSPACE(va, pc) ((uintptr)(va) & ~KSEGM | (pc) & KSEGM) enum {	/* alternates:	0xe12fff1e	BX (R14); last e is R14 */	/*		0xe28ef000	B 0(R14); second e is R14 (ken) */	Retinst	= 0xe1a0f00e,		/* MOV R14, R15 */}; voidcpwr(int cp, int op1, int crn, int crm, int op2, ulong val){	volatile ulong instr[2];	void *pcaddr;	void (*fp)(ulong); 	op1 &= 7;	op2 &= 7;	crn &= 017;	crm &= 017;	cp &= 017;	/* MCR.  Rt will be R0. */	instr[0] = 0xee000010 |		op1 << 21 | crn << 16 | cp << 8 | op2 << 5 | crm;	instr[1] = Retinst; 	pcaddr = (void *)MAP2PCSPACE(instr, getcallerpc(&cp));	cachedwbse(pcaddr, sizeof instr);	cacheiinv(); 	fp = (void (*)(ulong))pcaddr;	(*fp)(val);	coherence();} voidcpwrsc(int op1, int crn, int crm, int op2, ulong val){	cpwr(CpSC, op1, crn, crm, op2, val);} ulongcprd(int cp, int op1, int crn, int crm, int op2){	volatile ulong instr[2];	void *pcaddr;	ulong (*fp)(void); 	op1 &= 7;	op2 &= 7;	crn &= 017;	crm &= 017;	/*	 * MRC.  return value will be in R0, which is convenient.	 * Rt will be R0.	 */	instr[0] = 0xee100010 |		op1 << 21 | crn << 16 | cp << 8 | op2 << 5 | crm;	instr[1] = Retinst; 	pcaddr = (void *)MAP2PCSPACE(instr, getcallerpc(&cp));	cachedwbse(pcaddr, sizeof instr);	cacheiinv(); 	fp = (ulong (*)(void))pcaddr;	return (*fp)();} ulongcprdsc(int op1, int crn, int crm, int op2){	return cprd(CpSC, op1, crn, crm, op2);} /* floating point */ ulongfprd(int fpreg){	volatile ulong instr[2];	void *pcaddr;	ulong (*fp)(void); 	fpreg &= 017;	/*	 * VMRS.  return value will be in R0, which is convenient.	 * Rt will be R0.	 */	instr[0] = 0xeef00a10 | fpreg << 16 | 0 << 12;	instr[1] = Retinst;	coherence(); 	pcaddr = (void *)MAP2PCSPACE(instr, getcallerpc(&fpreg));	cachedwbse(pcaddr, sizeof instr);	cacheiinv(); 	fp = (ulong (*)(void))pcaddr;	return (*fp)();} voidfpwr(int fpreg, ulong val){	volatile ulong instr[2];	void *pcaddr;	void (*fp)(ulong); 	fpreg &= 017;	/* VMSR.  Rt will be R0. */	instr[0] = 0xeee00a10 | fpreg << 16 | 0 << 12;	instr[1] = Retinst;	coherence(); 	pcaddr = (void *)MAP2PCSPACE(instr, getcallerpc(&fpreg));	cachedwbse(pcaddr, sizeof instr);	cacheiinv(); 	fp = (void (*)(ulong))pcaddr;	(*fp)(val);	coherence();}

Keyboard shortcuts

General

Show keyboard shortcuts
?
Focus the current search
/

Issues and pull requests

Open filters
f

Issues, pull requests and Inbox

Select next item
j↓
Select previous item
k↑
Open selected item
Enter
Dismiss filters or clear selection
Esc

Repository code

Go to file
t