|
|
1.1 root 1: #include <sys/segments.h>
2: #include <go32.h>
3: #include <unistd.h>
4: #include <sys/nearptr.h>
5: #include <dos.h>
6: #include <string.h>
7: #include <dpmi.h>
8: // #include <osfcn.h>
9: #include <bios.h>
10:
11: #include "dosisms.h"
12:
13: _go32_dpmi_registers hmm;
14:
15: // globals
16: regs_t regs;
17: void (*dos_error_func)(char *msg, ...);
18:
19: static unsigned conventional_memory = -1;
20:
21: __dpmi_regs callback_regs;
22:
23: void map_in_conventional_memory(void)
24: {
25: if (conventional_memory == -1)
26: {
27: if (__djgpp_nearptr_enable())
28: {
29: conventional_memory = __djgpp_conventional_base;
30: }
31: }
32: }
33:
34: unsigned int ptr2real(void *ptr)
35: {
36: map_in_conventional_memory();
37: return (int)ptr - conventional_memory;
38: }
39:
40: void *real2ptr(unsigned int real)
41: {
42: map_in_conventional_memory();
43: return (void *) (real + conventional_memory);
44: }
45:
46: void *far2ptr(unsigned int farptr)
47: {
48: return real2ptr(((farptr & ~0xffff) >>12) + (farptr&0xffff));
49: }
50:
51: unsigned int ptr2far(void *ptr)
52: {
53: return ((ptr2real(ptr)&~0xf) << 12) + (ptr2real(ptr) & 0xf);
54: }
55:
56: int dos_inportb(int port)
57: {
58: return inportb(port);
59: }
60:
61: int dos_inportw(int port)
62: {
63: return inportw(port);
64: }
65:
66: void dos_outportb(int port, int val)
67: {
68: outportb(port, val);
69: }
70:
71: void dos_outportw(int port, int val)
72: {
73: outportw(port, val);
74: }
75:
76: void dos_irqenable(void)
77: {
78: enable();
79: }
80:
81: void dos_irqdisable(void)
82: {
83: disable();
84: }
85:
86: //
87: // Returns 0 on success
88: //
89:
90: int dos_int86(int vec)
91: {
92: int rc;
93: regs.x.ss = regs.x.sp = 0;
94: rc = _go32_dpmi_simulate_int(vec, (_go32_dpmi_registers *) ®s);
95: return rc || (regs.x.flags & 1);
96: }
97:
98: int dos_int386(int vec, regs_t *inregs, regs_t *outregs)
99: {
100: int rc;
101: memcpy(outregs, inregs, sizeof(regs_t));
102: outregs->x.ss = outregs->x.sp = 0;
103: rc = _go32_dpmi_simulate_int(vec, (_go32_dpmi_registers *) outregs);
104: return rc || (outregs->x.flags & 1);
105: }
106:
107: //
108: // Because of a quirk in dj's alloc-dos-memory wrapper, you need to keep
109: // the seginfo structure around for when you free the mem.
110: //
111:
112: static _go32_dpmi_seginfo seginfo[10];
113:
114: void *dos_getmemory(int size)
115: {
116:
117: int rc;
118: _go32_dpmi_seginfo info;
119: static int firsttime=1;
120: int i;
121:
122: if (firsttime)
123: {
124: memset(seginfo, 0, sizeof(seginfo));
125: firsttime = 0;
126: }
127:
128: info.size = (size+15) / 16;
129: rc = _go32_dpmi_allocate_dos_memory(&info);
130: if (rc)
131: return 0;
132:
133: for (i=0;i<10;i++)
134: if (!seginfo[i].rm_segment) break;
135: seginfo[i] = info;
136: return real2ptr((int) info.rm_segment << 4);
137:
138: }
139:
140: void dos_freememory(void *ptr)
141: {
142:
143: int i;
144: int segment;
145:
146: segment = ptr2real(ptr) >> 4;
147: for (i=0 ; i<10 ; i++)
148: if (seginfo[i].rm_segment == segment)
149: {
150: _go32_dpmi_free_dos_memory(&seginfo[i]);
151: seginfo[i].rm_segment = 0;
152: break;
153: }
154:
155: }
156:
157: static struct handlerhistory_s
158: {
159: int intr;
160: _go32_dpmi_seginfo pm_oldvec;
161: } handlerhistory[4];
162:
163: static int handlercount=0;
164:
165: void dos_registerintr(int intr, void (*handler)(void))
166: {
167: _go32_dpmi_seginfo info;
168: struct handlerhistory_s *oldstuff;
169:
170: oldstuff = &handlerhistory[handlercount];
171:
172: // remember old handler
173: _go32_dpmi_get_protected_mode_interrupt_vector(intr, &oldstuff->pm_oldvec);
174: oldstuff->intr = intr;
175:
176: info.pm_offset = (int) handler;
177: _go32_dpmi_allocate_iret_wrapper(&info);
178:
179: // set new protected mode handler
180: _go32_dpmi_set_protected_mode_interrupt_vector(intr, &info);
181:
182: handlercount++;
183:
184: }
185:
186: void dos_restoreintr(int intr)
187: {
188:
189: int i;
190: struct handlerhistory_s *oldstuff;
191:
192: // find and reinstall previous interrupt
193: for (i=0 ; i<handlercount ; i++)
194: {
195: oldstuff = &handlerhistory[i];
196: if (oldstuff->intr == intr)
197: {
198: _go32_dpmi_set_protected_mode_interrupt_vector(intr,
199: &oldstuff->pm_oldvec);
200: oldstuff->intr = -1;
201: break;
202: }
203: }
204:
205: }
206:
207: void dos_usleep(int usecs)
208: {
209: usleep(usecs);
210: }
211:
212: int dos_getheapsize(void)
213: {
214: return _go32_dpmi_remaining_physical_memory();
215: }
216:
217: int dos_lockmem(void *addr, int size)
218: {
219: __dpmi_meminfo info;
220: info.address = (long) addr + __djgpp_base_address;
221: info.size = size;
222: if (__dpmi_lock_linear_region(&info))
223: return __dpmi_error;
224: else
225: return 0;
226: }
227:
228: int dos_unlockmem(void *addr, int size)
229: {
230: __dpmi_meminfo info;
231: info.address = (long) addr + __djgpp_base_address;
232: info.size = size;
233: if (__dpmi_unlock_linear_region(&info))
234: return __dpmi_error;
235: else
236: return 0;
237: }
238:
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.