1*51f48f69SDavid du Colombier #define _LOCK_EXTENSION
2*51f48f69SDavid du Colombier #include <stdlib.h>
3*51f48f69SDavid du Colombier #include <string.h>
4*51f48f69SDavid du Colombier #include "../plan9/sys9.h"
5*51f48f69SDavid du Colombier #include <lock.h>
6*51f48f69SDavid du Colombier
7*51f48f69SDavid du Colombier enum
8*51f48f69SDavid du Colombier {
9*51f48f69SDavid du Colombier Pagesize = 4096,
10*51f48f69SDavid du Colombier Semperpg = Pagesize/(16*sizeof(unsigned int)),
11*51f48f69SDavid du Colombier Lockaddr = 0x60000000,
12*51f48f69SDavid du Colombier
13*51f48f69SDavid du Colombier POWER = 0x320,
14*51f48f69SDavid du Colombier MAGNUM = 0x330,
15*51f48f69SDavid du Colombier MAGNUMII = 0x340,
16*51f48f69SDavid du Colombier R4K = 0x500,
17*51f48f69SDavid du Colombier };
18*51f48f69SDavid du Colombier
19*51f48f69SDavid du Colombier static int arch;
20*51f48f69SDavid du Colombier extern int C_3ktas(int*);
21*51f48f69SDavid du Colombier extern int C_4ktas(int*);
22*51f48f69SDavid du Colombier extern int C_fcr0(void);
23*51f48f69SDavid du Colombier
24*51f48f69SDavid du Colombier static void
lockinit(void)25*51f48f69SDavid du Colombier lockinit(void)
26*51f48f69SDavid du Colombier {
27*51f48f69SDavid du Colombier int n;
28*51f48f69SDavid du Colombier
29*51f48f69SDavid du Colombier if(arch != 0)
30*51f48f69SDavid du Colombier return; /* allow multiple calls */
31*51f48f69SDavid du Colombier arch = C_fcr0();
32*51f48f69SDavid du Colombier switch(arch) {
33*51f48f69SDavid du Colombier case POWER:
34*51f48f69SDavid du Colombier n = _SEGATTACH(0, "lock", (void*)Lockaddr, Pagesize);
35*51f48f69SDavid du Colombier if(n < 0) {
36*51f48f69SDavid du Colombier arch = MAGNUM;
37*51f48f69SDavid du Colombier break;
38*51f48f69SDavid du Colombier }
39*51f48f69SDavid du Colombier memset((void*)Lockaddr, 0, Pagesize);
40*51f48f69SDavid du Colombier break;
41*51f48f69SDavid du Colombier case MAGNUM:
42*51f48f69SDavid du Colombier case MAGNUMII:
43*51f48f69SDavid du Colombier case R4K:
44*51f48f69SDavid du Colombier break;
45*51f48f69SDavid du Colombier default:
46*51f48f69SDavid du Colombier arch = R4K;
47*51f48f69SDavid du Colombier break;
48*51f48f69SDavid du Colombier }
49*51f48f69SDavid du Colombier
50*51f48f69SDavid du Colombier }
51*51f48f69SDavid du Colombier
52*51f48f69SDavid du Colombier void
lock(Lock * lk)53*51f48f69SDavid du Colombier lock(Lock *lk)
54*51f48f69SDavid du Colombier {
55*51f48f69SDavid du Colombier int *hwsem;
56*51f48f69SDavid du Colombier int hash;
57*51f48f69SDavid du Colombier
58*51f48f69SDavid du Colombier retry:
59*51f48f69SDavid du Colombier switch(arch) {
60*51f48f69SDavid du Colombier case 0:
61*51f48f69SDavid du Colombier lockinit();
62*51f48f69SDavid du Colombier goto retry;
63*51f48f69SDavid du Colombier case MAGNUM:
64*51f48f69SDavid du Colombier case MAGNUMII:
65*51f48f69SDavid du Colombier while(C_3ktas(&lk->val))
66*51f48f69SDavid du Colombier _SLEEP(0);
67*51f48f69SDavid du Colombier return;
68*51f48f69SDavid du Colombier case R4K:
69*51f48f69SDavid du Colombier for(;;){
70*51f48f69SDavid du Colombier while(lk->val)
71*51f48f69SDavid du Colombier ;
72*51f48f69SDavid du Colombier if(C_4ktas(&lk->val) == 0)
73*51f48f69SDavid du Colombier return;
74*51f48f69SDavid du Colombier }
75*51f48f69SDavid du Colombier break;
76*51f48f69SDavid du Colombier case POWER:
77*51f48f69SDavid du Colombier /* Use low order lock bits to generate hash */
78*51f48f69SDavid du Colombier hash = ((int)lk/sizeof(int)) & (Semperpg-1);
79*51f48f69SDavid du Colombier hwsem = (int*)Lockaddr+hash;
80*51f48f69SDavid du Colombier
81*51f48f69SDavid du Colombier for(;;) {
82*51f48f69SDavid du Colombier if((*hwsem & 1) == 0) {
83*51f48f69SDavid du Colombier if(lk->val)
84*51f48f69SDavid du Colombier *hwsem = 0;
85*51f48f69SDavid du Colombier else {
86*51f48f69SDavid du Colombier lk->val = 1;
87*51f48f69SDavid du Colombier *hwsem = 0;
88*51f48f69SDavid du Colombier return;
89*51f48f69SDavid du Colombier }
90*51f48f69SDavid du Colombier }
91*51f48f69SDavid du Colombier while(lk->val)
92*51f48f69SDavid du Colombier ;
93*51f48f69SDavid du Colombier }
94*51f48f69SDavid du Colombier }
95*51f48f69SDavid du Colombier }
96*51f48f69SDavid du Colombier
97*51f48f69SDavid du Colombier int
canlock(Lock * lk)98*51f48f69SDavid du Colombier canlock(Lock *lk)
99*51f48f69SDavid du Colombier {
100*51f48f69SDavid du Colombier int *hwsem;
101*51f48f69SDavid du Colombier int hash;
102*51f48f69SDavid du Colombier
103*51f48f69SDavid du Colombier retry:
104*51f48f69SDavid du Colombier switch(arch) {
105*51f48f69SDavid du Colombier case 0:
106*51f48f69SDavid du Colombier lockinit();
107*51f48f69SDavid du Colombier goto retry;
108*51f48f69SDavid du Colombier case MAGNUM:
109*51f48f69SDavid du Colombier case MAGNUMII:
110*51f48f69SDavid du Colombier if(C_3ktas(&lk->val))
111*51f48f69SDavid du Colombier return 0;
112*51f48f69SDavid du Colombier return 1;
113*51f48f69SDavid du Colombier case R4K:
114*51f48f69SDavid du Colombier if(C_4ktas(&lk->val))
115*51f48f69SDavid du Colombier return 0;
116*51f48f69SDavid du Colombier return 1;
117*51f48f69SDavid du Colombier case POWER:
118*51f48f69SDavid du Colombier /* Use low order lock bits to generate hash */
119*51f48f69SDavid du Colombier hash = ((int)lk/sizeof(int)) & (Semperpg-1);
120*51f48f69SDavid du Colombier hwsem = (int*)Lockaddr+hash;
121*51f48f69SDavid du Colombier
122*51f48f69SDavid du Colombier if((*hwsem & 1) == 0) {
123*51f48f69SDavid du Colombier if(lk->val)
124*51f48f69SDavid du Colombier *hwsem = 0;
125*51f48f69SDavid du Colombier else {
126*51f48f69SDavid du Colombier lk->val = 1;
127*51f48f69SDavid du Colombier *hwsem = 0;
128*51f48f69SDavid du Colombier return 1;
129*51f48f69SDavid du Colombier }
130*51f48f69SDavid du Colombier }
131*51f48f69SDavid du Colombier return 0;
132*51f48f69SDavid du Colombier default:
133*51f48f69SDavid du Colombier return 0;
134*51f48f69SDavid du Colombier }
135*51f48f69SDavid du Colombier }
136*51f48f69SDavid du Colombier
137*51f48f69SDavid du Colombier void
unlock(Lock * lk)138*51f48f69SDavid du Colombier unlock(Lock *lk)
139*51f48f69SDavid du Colombier {
140*51f48f69SDavid du Colombier lk->val = 0;
141*51f48f69SDavid du Colombier }
142*51f48f69SDavid du Colombier
143*51f48f69SDavid du Colombier int
tas(int * p)144*51f48f69SDavid du Colombier tas(int *p)
145*51f48f69SDavid du Colombier {
146*51f48f69SDavid du Colombier int *hwsem;
147*51f48f69SDavid du Colombier int hash;
148*51f48f69SDavid du Colombier
149*51f48f69SDavid du Colombier retry:
150*51f48f69SDavid du Colombier switch(arch) {
151*51f48f69SDavid du Colombier case 0:
152*51f48f69SDavid du Colombier lockinit();
153*51f48f69SDavid du Colombier goto retry;
154*51f48f69SDavid du Colombier case MAGNUM:
155*51f48f69SDavid du Colombier case MAGNUMII:
156*51f48f69SDavid du Colombier return C_3ktas(p);
157*51f48f69SDavid du Colombier case R4K:
158*51f48f69SDavid du Colombier return C_4ktas(p);
159*51f48f69SDavid du Colombier case POWER:
160*51f48f69SDavid du Colombier /* Use low order lock bits to generate hash */
161*51f48f69SDavid du Colombier hash = ((int)p/sizeof(int)) & (Semperpg-1);
162*51f48f69SDavid du Colombier hwsem = (int*)Lockaddr+hash;
163*51f48f69SDavid du Colombier
164*51f48f69SDavid du Colombier if((*hwsem & 1) == 0) {
165*51f48f69SDavid du Colombier if(*p)
166*51f48f69SDavid du Colombier *hwsem = 0;
167*51f48f69SDavid du Colombier else {
168*51f48f69SDavid du Colombier *p = 1;
169*51f48f69SDavid du Colombier *hwsem = 0;
170*51f48f69SDavid du Colombier return 0;
171*51f48f69SDavid du Colombier }
172*51f48f69SDavid du Colombier }
173*51f48f69SDavid du Colombier return 1;
174*51f48f69SDavid du Colombier default:
175*51f48f69SDavid du Colombier return 0;
176*51f48f69SDavid du Colombier }
177*51f48f69SDavid du Colombier }
178