![[BACK]](/cvsweb/icons/back.gif){kind=icon}
Return to dynasty.c CVS log ![[TXT]](/cvsweb/icons/text.gif){kind=icon}
![[DIR]](/cvsweb/icons/dir.gif){kind=icon}
Up to [Research Unix] / researchv10no / cmd / vsw|
Return to dynasty.c CVS log | Up to [Research Unix] / researchv10no / cmd / vsw |
1.1 root 1: #include <libc.h>
2: #include <fio.h>
3: #include <sysent.h>
4: #include <string.h>
5: #include <errno.h>
6: #include "crossbar.h"
7:
8: extern int verbose;
9: static ntilt;
10: #define MAXTILT 5
11:
12: Dynasty::Dynasty(char *dkname, int n, int depth) : (dkname, n, depth)
13: {
14: }
15:
16: void
17: Dynasty::startup()
18: {
19: char buf[256];
20: extern int opendk(char *);
21:
22: fd = opendk(dial);
23: tocontrol();
24: }
25:
26: void
27: Dynasty::tocontrol()
28: {
29: for(;;){
30: put1(0xAC);
31: if(get1(0xFB) == 0)
32: break;
33: sleep(1);
34: }
35: }
36:
37: void
38: Dynasty::config()
39: {
40: int i, j;
41:
42: imap = new int[nouts];
43: ntilt = 0;
44: for(i = 0; i < nouts; i++){
45: again:
46: if(ntilt > MAXTILT){
47: fprint(2, "vsw: too many (%d) tilts, exiting\n", ntilt);
48: exit(1);
49: }
50: put1(0xDA);
51: putn(i);
52: if(get1(0xAB)){
53: sleep(1);
54: tocontrol();
55: goto again;
56: }
57: j = getn(8);
58: put1(0xFB);
59: imap[i] = j;
60: }
61: }
62:
63: int
64: Dynasty::connect(int input, Crossbar *c, int output, int nw)
65: {
66: char buf[256];
67:
68: if(fd < 0)
69: startup();
70: if(c != this){
71: if(nextc->connect(nextl, c, output, nw) == 0)
72: return(0);
73: output = froml;
74: }
75: nw = (nw+nwires-1)/nwires;
76: while(nw-- > 0){
77: put1(0xCF);
78: putn(output);
79: putn(input);
80: if(get1(0xFB)){
81: fprint(2, "%s.con %d->%d failed\n", name(), input, output);
82: return(0);
83: }
84: input++, output++;
85: }
86: return(1);
87: }
88:
89: void
90: Dynasty::put1(unsigned char x)
91: {
92: if(write(fd, (char *)&x, 1) != 1)
93: perror("WRITE");
94: }
95:
96: void
97: Dynasty::putn(int i)
98: {
99: unsigned char wbuf[2];
100:
101: wbuf[0] = i/100;
102: wbuf[1] = i%10 | (((i/10)%10)<<4);
103: if(write(fd, (char *)wbuf, 2) != 2)
104: perror("putn");
105: }
106:
107: int
108: Dynasty::get1(unsigned char x)
109: {
110: unsigned char r;
111: char buf[60];
112:
113: alarm(2);
114: if(read(fd, (char *)&r, 1) != 1){
115: if(errno != EINTR)
116: perror("READ");
117: else
118: fprint(2, "vsw: timeout, retrying\n"), tocontrol();
119: return(1);
120: }
121: alarm(0);
122: if(r != x){
123: switch(r)
124: {
125: case 0xF0:
126: ntilt++;
127: break;
128: case 0xAB:
129: alarm(2);
130: read(fd, buf, 8);
131: alarm(0);
132: print("continue(#%ux#%ux#%ux#%ux#%ux#%ux#%ux#%ux)\n",buf[0],buf[1],buf[2],buf[3],buf[4],buf[5],buf[6],buf[7]);
133: break;
134: case 0xAD:
135: alarm(2);
136: read(fd, buf, 10);
137: alarm(0);
138: print("autostatus(#%ux#%ux#%ux#%ux#%ux#%ux#%ux#%ux#%ux#%ux)\n",buf[0],buf[1],buf[2],buf[3],buf[4],buf[5],buf[6],buf[7],buf[8],buf[9]);
139: break;
140: default:
141: fprint(2, "READ(#%2.2x): got #%2.2x\n", x, r);
142: break;
143: }
144: return(1);
145: }
146: return(0);
147: }
148:
149: int
150: Dynasty::getn(int n)
151: {
152: unsigned char r[64];
153:
154: if(read(fd, (char *)r, n) != n)
155: perror("getn");
156: return((r[0]&0xF)*100 + ((r[1]>>4)&0xF)*10 + (r[1]&0xF));
157: }
158:
159: #ifdef CRAP
160:
161: int verbose;
162: int rfs;
163:
164: #define WRITE(x) { char wbuf[1]; wbuf[0] = x; if(write(rfs, wbuf, 1) != 1) perror("WRITE"); }
165:
166: WRITEN(i)
167: {
168: unsigned char wbuf[2];
169:
170: wbuf[0] = i/100;
171: wbuf[1] = i%10 | (((i/10)%10)<<4);
172: if(write(rfs, wbuf, 2) != 2)
173: perror("WRITEN");
174: }
175:
176: READ(x)
177: {
178: unsigned char rbuf[1];
179: if(read(rfs, rbuf, 1) != 1)
180: perror("READ");
181: if(rbuf[0] != x){
182: fprint(2, "READ(#%2.2x): got #%2.2x\n", x, rbuf[0]);
183: return(1);
184: }
185: return(0);
186: }
187:
188: READN(buf, n)
189: unsigned char buf[];
190: {
191: int i;
192:
193: for(i = 0; i < n; i++)
194: if(read(rfs, &buf[i], 1) != 1){
195: perror("READ");
196: return(1);
197: }
198: return(0);
199: }
200:
201: main(argc, argv)
202: char **argv;
203: {
204: int i, n, in, out;
205: char buf[256];
206: struct sgttyb vvec;
207: extern int tty_ld;
208:
209: if((argc = getflags(argc, argv, "dcrvpPi", 0)) < 0)
210: usage("[ iopair ... ]");
211: verbose = flag['v'] != 0;
212: sprint(buf, "/cs/dk!%s", "vswrgb2");
213: rfs = ipcopen(buf, "light");
214: if(rfs < 0){
215: perror(buf);
216: exit(1);
217: }
218: if(ioctl(rfs, FIOLOOKLD, 0) != tty_ld){
219: if(ioctl(rfs, FIOPUSHLD, &tty_ld) < 0){
220: perror("tty_ld");
221: exit(1);
222: }
223: }
224: vvec.sg_flags = RAW;
225: vvec.sg_erase = 0;
226: vvec.sg_kill = 0;
227: if(ioctl(rfs, TIOCSETP, &vvec) < 0){
228: perror("ioctl");
229: exit(1);
230: }
231: tocontrol();
232: print("in control:\n");
233: status();
234: exit(0);
235: }
236:
237: tocontrol()
238: {
239: WRITE(0xAC);
240: return(READ(0xFB));
241: }
242:
243: status()
244: {
245: int i, n;
246: unsigned char buf[8];
247:
248: for(i = 0; i < 5; i++){
249: n = status1(i, buf);
250: print("%d: status1 ret=%d; %x %x %x %x %x %x %x %x\n", i, n, buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], buf[6], buf[7]);
251: }
252: }
253:
254: status1(i, buf)
255: unsigned char *buf;
256: {
257: WRITE(0xDA);
258: WRITEN(i);
259: if(i = READ(0xAB))
260: return(i);
261: if(i = READN(buf, 8))
262: return(i);
263: WRITE(0xFB);
264: sleep(1);
265: return(0);
266: }
267: #endif
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.