| 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 |
} |