xref: /plan9-contrib/sys/src/ape/lib/ap/spim64/notetramp.c (revision 6c6e36e1134c52b146e9d71d8c7dc193994c0c4e)
1*6c6e36e1SDavid du Colombier #include "../plan9/lib.h"
2*6c6e36e1SDavid du Colombier #include "../plan9/sys9.h"
3*6c6e36e1SDavid du Colombier #include <signal.h>
4*6c6e36e1SDavid du Colombier #include <setjmp.h>
5*6c6e36e1SDavid du Colombier 
6*6c6e36e1SDavid du Colombier /* A stack to hold pcs when signals nest */
7*6c6e36e1SDavid du Colombier #define MAXSIGSTACK 20
8*6c6e36e1SDavid du Colombier typedef struct Pcstack Pcstack;
9*6c6e36e1SDavid du Colombier static struct Pcstack {
10*6c6e36e1SDavid du Colombier 	int sig;
11*6c6e36e1SDavid du Colombier 	void (*hdlr)(int, char*, Ureg*);
12*6c6e36e1SDavid du Colombier 	unsigned long restorepc;
13*6c6e36e1SDavid du Colombier 	Ureg *u;
14*6c6e36e1SDavid du Colombier } pcstack[MAXSIGSTACK];
15*6c6e36e1SDavid du Colombier static int nstack = 0;
16*6c6e36e1SDavid du Colombier 
17*6c6e36e1SDavid du Colombier static void notecont(Ureg*, char*);
18*6c6e36e1SDavid du Colombier 
19*6c6e36e1SDavid du Colombier void
_notetramp(int sig,void (* hdlr)(int,char *,Ureg *),Ureg * u)20*6c6e36e1SDavid du Colombier _notetramp(int sig, void (*hdlr)(int, char*, Ureg*), Ureg *u)
21*6c6e36e1SDavid du Colombier {
22*6c6e36e1SDavid du Colombier 	Pcstack *p;
23*6c6e36e1SDavid du Colombier 
24*6c6e36e1SDavid du Colombier 	if(nstack >= MAXSIGSTACK)
25*6c6e36e1SDavid du Colombier 		_NOTED(1);	/* nesting too deep; just do system default */
26*6c6e36e1SDavid du Colombier 	p = &pcstack[nstack];
27*6c6e36e1SDavid du Colombier 	p->restorepc = u->pc;
28*6c6e36e1SDavid du Colombier 	p->sig = sig;
29*6c6e36e1SDavid du Colombier 	p->hdlr = hdlr;
30*6c6e36e1SDavid du Colombier 	p->u = u;
31*6c6e36e1SDavid du Colombier 	nstack++;
32*6c6e36e1SDavid du Colombier 	u->pc = (unsigned long) notecont;
33*6c6e36e1SDavid du Colombier 	_NOTED(2);	/* NSAVE: clear note but hold state */
34*6c6e36e1SDavid du Colombier }
35*6c6e36e1SDavid du Colombier 
36*6c6e36e1SDavid du Colombier static void
notecont(Ureg * u,char * s)37*6c6e36e1SDavid du Colombier notecont(Ureg *u, char *s)
38*6c6e36e1SDavid du Colombier {
39*6c6e36e1SDavid du Colombier 	Pcstack *p;
40*6c6e36e1SDavid du Colombier 	void(*f)(int, char*, Ureg*);
41*6c6e36e1SDavid du Colombier 
42*6c6e36e1SDavid du Colombier 	p = &pcstack[nstack-1];
43*6c6e36e1SDavid du Colombier 	f = p->hdlr;
44*6c6e36e1SDavid du Colombier 	u->pc = p->restorepc;
45*6c6e36e1SDavid du Colombier 	nstack--;
46*6c6e36e1SDavid du Colombier 	(*f)(p->sig, s, u);
47*6c6e36e1SDavid du Colombier 	_NOTED(3);	/* NRSTR */
48*6c6e36e1SDavid du Colombier }
49*6c6e36e1SDavid du Colombier 
50*6c6e36e1SDavid du Colombier #define JMPBUFPC 1
51*6c6e36e1SDavid du Colombier #define JMPBUFSP 0
52*6c6e36e1SDavid du Colombier 
53*6c6e36e1SDavid du Colombier extern sigset_t	_psigblocked;
54*6c6e36e1SDavid du Colombier 
55*6c6e36e1SDavid du Colombier void
siglongjmp(sigjmp_buf j,int ret)56*6c6e36e1SDavid du Colombier siglongjmp(sigjmp_buf j, int ret)
57*6c6e36e1SDavid du Colombier {
58*6c6e36e1SDavid du Colombier 	struct Ureg *u;
59*6c6e36e1SDavid du Colombier 
60*6c6e36e1SDavid du Colombier 	if(j[0])
61*6c6e36e1SDavid du Colombier 		_psigblocked = j[1];
62*6c6e36e1SDavid du Colombier 	if(nstack == 0 || pcstack[nstack-1].u->sp > j[2+JMPBUFSP])
63*6c6e36e1SDavid du Colombier 		longjmp(j+2, ret);
64*6c6e36e1SDavid du Colombier 	u = pcstack[nstack-1].u;
65*6c6e36e1SDavid du Colombier 	nstack--;
66*6c6e36e1SDavid du Colombier 	u->r1 = ret;
67*6c6e36e1SDavid du Colombier 	if(ret == 0)
68*6c6e36e1SDavid du Colombier 		u->r1 = 1;
69*6c6e36e1SDavid du Colombier 	u->pc = j[2+JMPBUFPC];
70*6c6e36e1SDavid du Colombier 	u->sp = j[2+JMPBUFSP];
71*6c6e36e1SDavid du Colombier 	_NOTED(3);	/* NRSTR */
72*6c6e36e1SDavid du Colombier }
73