1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
|
/* Copyright (C) 1995,1996 Robert de Bath <rdebath@cix.compulink.co.uk>
* This file is part of the Linux-8086 C library and is distributed
* under the GNU Library General Public License.
*/
/*
* These functions will not normally be useful for Linux-8086. But they
* can be used and may be useful in the kernel.
*/
#ifdef __AS386_16__
#ifdef L___seg_regs
unsigned int
__get_cs()
{
#asm
mov ax,cs
#endasm
}
unsigned int
__get_ds()
{
#asm
mov ax,ds
#endasm
}
unsigned int
__get_es()
{
#asm
mov ax,es
#endasm
}
void
__set_es(seg)
{
#asm
#if __FIRST_ARG_IN_AX__
mov es,ax
#else
mov bx,sp
mov es,[bx+2]
#endif
#endasm
}
#endif
#ifdef L___peek_es
int
__peek_es(off)
unsigned int off;
{
#asm
#if __FIRST_ARG_IN_AX__
mov bx,ax
#else
mov bx,sp
mov bx,[bx+2]
#endif
seg es
mov al,[bx]
xor ah,ah
#endasm
}
#endif
#ifdef L___poke_es
int
__poke_es(off, value)
unsigned int off;
int value;
{
#asm
#if __FIRST_ARG_IN_AX__
mov bx,sp
mov bx,[bx+2]
xchg ax,bx
#else
mov bx,sp
mov ax,[bx+4]
mov bx,[bx+2]
#endif
seg es
mov [bx],al
xor ah,ah
#endasm
}
#endif
#ifdef L___deek_es
int
__deek_es(off)
unsigned int off;
{
#asm
#if __FIRST_ARG_IN_AX__
mov bx,ax
#else
mov bx,sp
mov bx,[bx+2]
#endif
seg es
mov ax,[bx]
#endasm
}
#endif
#ifdef L___doke_es
int
__doke_es(off, value)
unsigned int off;
int value;
{
#asm
#if __FIRST_ARG_IN_AX__
mov bx,sp
mov bx,[bx+2]
xchg ax,bx
#else
mov bx,sp
mov ax,[bx+4]
mov bx,[bx+2]
#endif
seg es
mov [bx],ax
#endasm
}
#endif
#ifdef L___strchr_es
char *
__strchr_es(s, c)
char * s;
int c;
{
#asm
mov bx,sp
push si
#if __FIRST_ARG_IN_AX__
mov bx,[bx+2]
mov si,ax
#else
mov si,[bx+2]
mov bx,[bx+4]
#endif
xor ax,ax
#ifdef PARANOID
cld
#endif
push ds
push es
pop ds
in_loop:
lodsb
cmp al,bl
jz got_it
or al,al
jnz in_loop
pop ds
pop si
ret
got_it:
lea ax,[si-1]
pop ds
pop si
#endasm
}
#endif
#ifdef L___strnget_es
char *
__strnget_es(d, s, c)
char *d;
char *s;
register int c;
{
register int i = __strlen_es(s);
if(i < c) c = i+1;
/* else s[--c] = 0; ?? */
/* else return -E2BIG; ?? */
__movedata(__get_es(), s, __get_ds(), d, c);
}
#endif
#ifdef L___strlen_es
int __strlen_es(str)
char * str;
{
#asm
#if !__FIRST_ARG_IN_AX__
mov bx,sp
#endif
push di
cld
#if __FIRST_ARG_IN_AX__
mov di,ax
#else
mov di,[bx+2]
#endif
mov cx,#-1
xor ax,ax
repne
scasb ! Scans [ES:DI]
not cx
dec cx
mov ax,cx
pop di
#endasm
}
#endif
#ifdef L_int86
int
int86(intr, in_regs, out_regs)
int intr;
union REGS* in_regs;
union REGS* out_regs;
{
#asm
push bp
mov bp,sp
push ds ! save ds
! es too ?
push bp ! same for new bp
pushf ! iret flags
mov ax,[bp-6] ! flags for simulated int
push cs ! iret address segment
mov bx,#ret_addr ! iret address offset
push bx
and ah,#$0C ! simulate interrupt flags
push ax ! flags are pushed first
xor bx,bx
mov es,bx ! interrupt vectors in seg 0
mov bl,[bp+4]
shl bx,#1
shl bx,#1 ! intr*4 => interrupt vector address
seg es
push [bx+2] ! fetch interrupt segment
seg es
push [bx] ! fetch interrupt offset
mov bx,[bp+6] ! input union REGS*
mov ax,[bx]
mov cx,[bx+4]
mov dx,[bx+6]
mov si,[bx+8]
mov di,[bx+10]
mov bx,[bx+2]
! Ignore cflag/flags ?
iret ! simulate interrupt.
! But won't be nice for protected mode ...
ret_addr:
! Int $25/6 would need resetting sp:ss too ... should I ?
pop bp ! unzapped versions
pop ds ! paranoia
pushf ! save interrupt flags
push bx ! save pointer register
mov bx,[bp+8] ! output union REGS*
mov [bx],ax
pop [bx+2]
mov [bx+4],cx
mov [bx+6],dx
mov [bx+8],si
mov [bx+10],di
mov word [bx+12],#0 ! cflag
jnc no_carry
mov byte [bx+12],#1
no_carry:
pop [bx+14] ! flags
pop bp
#endasm
}
#endif
#ifdef L_int86x
int
int86x(intr, in_regs, out_regs, segr)
int intr;
union REGS* in_regs;
union REGS* out_regs;
struct SREGS * segr;
{
#asm
push bp
mov bp,sp
push ds ! save ds
! es too ?
push bp ! same for new bp
pushf ! iret flags
mov ax,[bp-6] ! flags for simulated int
push cs ! iret address segment
mov bx,#ret_addr ! iret address offset
push bx
and ah,#$0C ! simulate interrupt flags
push ax ! flags are pushed first
xor bx,bx
mov es,bx ! interrupt vectors in seg 0
mov bl,[bp+4]
shl bx,1
shl bx,1 ! intr*4 => interrupt vector address
seg es
push word [bx+2] ! fetch interrupt segment
seg es
push word [bx] ! fetch interrupt offset
mov bx,[bp+10] ! struct SREGS*
mov es,[bx]
push [bx+6] ! ds
mov bx,[bp+6] ! input union REGS*
mov ax,[bx]
mov cx,[bx+4]
mov dx,[bx+6]
mov si,[bx+8]
mov di,[bx+10]
mov bx,[bx+2]
! Ignore cflag/flags ?
pop ds
iret ! simulate interrupt
! But won't be nice for protected mode ...
ret_addr:
! Int $25/6 would need resetting sp:ss too ... should I ?
pop bp ! in case it was zapped
pushf ! save interrupt flags
push cx ! save work register
mov cx,ds
push bx ! save pointer register
mov ds,word [bp-2] ! restore original ds
mov bx,[bp+10] ! struct SREGS*
mov [bx],es
mov [bx+6],cx
mov bx,[bp+8] ! output union REGS*
mov [bx],ax
pop [bx+2] ! bx
pop [bx+4] ! cx
mov [bx+6],dx
mov [bx+8],si
mov [bx+10],di
mov word [bx+12],#0 ! cflag
jnc no_carry
mov byte [bx+12],#1
no_carry:
pop [bx+14] ! flags
pop ds
pop bp
#endasm
}
#endif
#ifdef L_segread
segread(segp)
struct SREGS * segp;
{
#asm
#if __FIRST_ARG_IN_AX__
mov bx,ax
#else
mov bx,sp
mov bx,[bx+2]
#endif
mov [bx],es
mov [bx+2],cs
mov [bx+4],ss
mov [bx+6],ds
#endasm
}
#endif
#endif /* __AS386_16__ */
|