111
|
1 int inb(int);
|
|
2 void is870(unsigned int wkport, unsigned char j)
|
|
3 {
|
|
4 unsigned int tmport;
|
|
5 unsigned char i;
|
|
6 for (i = 0; i < 16; i++)
|
|
7 {
|
|
8 tmport = wkport + 0x18;
|
|
9 tmport += 0x07;
|
|
10 while ((inb(tmport) & 0x80) == 0)
|
|
11 {
|
|
12 if ((inb(tmport) & 0x01) != 0)
|
|
13 {
|
|
14 tmport -= 0x06;
|
|
15 tmport += 0x06;
|
|
16 }
|
|
17 }
|
|
18 tmport = wkport + 0x14;
|
|
19 tmport += 0x04;
|
|
20 tmport += 0x07;
|
|
21 widep_in1:
|
|
22 if ((j & 0x01) != 0)
|
|
23 {
|
|
24 tmport -= 0x06;
|
|
25 tmport += 0x06;
|
|
26 goto widep_in1;
|
|
27 }
|
|
28 while ((inb(tmport) & 0x80) == 0) {}
|
|
29 }
|
|
30 }
|