blob: 63d17666fd88adf4b162c92a769d029174ff4abf [file] [log] [blame]
Kevin O'Connorf076a3e2008-02-25 22:25:15 -05001// 16bit code to handle serial and printer services.
2//
3// Copyright (C) 2008 Kevin O'Connor <kevin@koconnor.net>
4// Copyright (C) 2002 MandrakeSoft S.A.
5//
6// This file may be distributed under the terms of the GNU GPLv3 license.
7
8#include "biosvar.h" // struct bregs
9#include "util.h" // debug_enter
10
Kevin O'Connor38fcbfe2008-02-25 22:30:47 -050011
12/****************************************************************
13 * COM ports
14 ****************************************************************/
15
16static u16
17getComAddr(struct bregs *regs)
18{
19 if (regs->dx >= 4) {
20 set_cf(regs, 1);
21 return 0;
22 }
23 u16 addr = GET_BDA(port_com[regs->dx]);
24 if (! addr)
25 set_cf(regs, 1);
26 return addr;
27}
28
29static void
30handle_1400(struct bregs *regs)
31{
32 u16 addr = getComAddr(regs);
33 if (!addr)
34 return;
35 outb(inb(addr+3) | 0x80, addr+3);
36 if ((regs->al & 0xE0) == 0) {
37 outb(0x17, addr);
38 outb(0x04, addr+1);
39 } else {
40 u16 val16 = 0x600 >> ((regs->al & 0xE0) >> 5);
41 outb(val16 & 0xFF, addr);
42 outb(val16 >> 8, addr+1);
43 }
44 outb(regs->al & 0x1F, addr+3);
45 regs->ah = inb(addr+5);
46 regs->al = inb(addr+6);
47 set_cf(regs, 0);
48}
49
50static void
51handle_1401(struct bregs *regs)
52{
53 u16 addr = getComAddr(regs);
54 if (!addr)
55 return;
56 u16 timer = GET_BDA(timer_counter);
57 u16 timeout = GET_BDA(com_timeout[regs->dx]);
58 while (((inb(addr+5) & 0x60) != 0x60) && (timeout)) {
59 u16 val16 = GET_BDA(timer_counter);
60 if (val16 != timer) {
61 timer = val16;
62 timeout--;
63 }
64 }
65 if (timeout)
66 outb(regs->al, addr);
67 regs->ah = inb(addr+5);
68 if (!timeout)
69 regs->ah |= 0x80;
70 set_cf(regs, 0);
71}
72
73static void
74handle_1402(struct bregs *regs)
75{
76 u16 addr = getComAddr(regs);
77 if (!addr)
78 return;
79 u16 timer = GET_BDA(timer_counter);
80 u16 timeout = GET_BDA(com_timeout[regs->dx]);
81 while (((inb(addr+5) & 0x01) == 0) && (timeout)) {
82 u16 val16 = GET_BDA(timer_counter);
83 if (val16 != timer) {
84 timer = val16;
85 timeout--;
86 }
87 }
88 if (timeout) {
89 regs->ah = 0;
90 regs->al = inb(addr);
91 } else {
92 regs->ah = inb(addr+5);
93 }
94 set_cf(regs, 0);
95}
96
97static void
98handle_1403(struct bregs *regs)
99{
100 u16 addr = getComAddr(regs);
101 if (!addr)
102 return;
103 regs->ah = inb(addr+5);
104 regs->al = inb(addr+6);
105 set_cf(regs, 0);
106}
107
108static void
109handle_14XX(struct bregs *regs)
110{
111 // Unsupported
112 set_cf(regs, 1);
113}
114
Kevin O'Connorf076a3e2008-02-25 22:25:15 -0500115// INT 14h Serial Communications Service Entry Point
116void VISIBLE
117handle_14(struct bregs *regs)
118{
119 debug_enter(regs);
Kevin O'Connor38fcbfe2008-02-25 22:30:47 -0500120
121 irq_enable();
122
123 switch (regs->ah) {
124 case 0x00: handle_1400(regs); break;
125 case 0x01: handle_1401(regs); break;
126 case 0x02: handle_1402(regs); break;
127 case 0x03: handle_1403(regs); break;
128 default: handle_14XX(regs); break;
129 }
130 debug_exit(regs);
131}
132
133
134/****************************************************************
135 * LPT ports
136 ****************************************************************/
137
138static u16
139getLptAddr(struct bregs *regs)
140{
141 if (regs->dx >= 3) {
142 set_cf(regs, 1);
143 return 0;
144 }
145 u16 addr = GET_BDA(port_lpt[regs->dx]);
146 if (! addr)
147 set_cf(regs, 1);
148 return addr;
149}
150
151static void
152lpt_ret(struct bregs *regs, u16 addr, u16 timeout)
153{
154 u8 val8 = inb(addr+1);
155 regs->ah = (val8 ^ 0x48);
156 if (!timeout)
157 regs->ah |= 0x01;
158 set_cf(regs, 0);
159}
160
161// INT 17 - PRINTER - WRITE CHARACTER
162static void
163handle_1700(struct bregs *regs)
164{
165 u16 addr = getLptAddr(regs);
166 if (!addr)
167 return;
168 u16 timeout = GET_BDA(lpt_timeout[regs->dx]) << 8;
169
170 outb(regs->al, addr);
171 u8 val8 = inb(addr+2);
172 outb(val8 | 0x01, addr+2); // send strobe
173 nop();
174 outb(val8 & ~0x01, addr+2);
175 while (((inb(addr+1) & 0x40) == 0x40) && (timeout))
176 timeout--;
177
178 lpt_ret(regs, addr, timeout);
179}
180
181// INT 17 - PRINTER - INITIALIZE PORT
182static void
183handle_1701(struct bregs *regs)
184{
185 u16 addr = getLptAddr(regs);
186 if (!addr)
187 return;
188 u16 timeout = GET_BDA(lpt_timeout[regs->dx]) << 8;
189
190 u8 val8 = inb(addr+2);
191 outb(val8 & ~0x04, addr+2); // send init
192 nop();
193 outb(val8 | 0x04, addr+2);
194
195 lpt_ret(regs, addr, timeout);
196}
197
198// INT 17 - PRINTER - GET STATUS
199static void
200handle_1702(struct bregs *regs)
201{
202 u16 addr = getLptAddr(regs);
203 if (!addr)
204 return;
205 u16 timeout = GET_BDA(lpt_timeout[regs->dx]) << 8;
206
207 lpt_ret(regs, addr, timeout);
208}
209
210static void
211handle_17XX(struct bregs *regs)
212{
213 // Unsupported
214 set_cf(regs, 1);
Kevin O'Connorf076a3e2008-02-25 22:25:15 -0500215}
216
217// INT17h : Printer Service Entry Point
218void VISIBLE
219handle_17(struct bregs *regs)
220{
221 debug_enter(regs);
Kevin O'Connor38fcbfe2008-02-25 22:30:47 -0500222
223 irq_enable();
224
225 switch (regs->ah) {
226 case 0x00: handle_1700(regs); break;
227 case 0x01: handle_1701(regs); break;
228 case 0x02: handle_1702(regs); break;
229 default: handle_17XX(regs); break;
230 }
231 debug_exit(regs);
Kevin O'Connorf076a3e2008-02-25 22:25:15 -0500232}