spx.c revision 1.2.2.3 1 1.2.2.3 yamt /* $NetBSD: spx.c,v 1.2.2.3 2010/08/11 22:52:52 yamt Exp $ */
2 1.2.2.2 yamt /*
3 1.2.2.2 yamt * SPX/LCSPX/SPXg/SPXgt accelerated framebuffer driver for NetBSD/VAX
4 1.2.2.2 yamt * Copyright (c) 2005 Blaz Antonic
5 1.2.2.2 yamt * All rights reserved.
6 1.2.2.2 yamt *
7 1.2.2.2 yamt * This software contains code written by Michael L. Hitch.
8 1.2.2.2 yamt *
9 1.2.2.2 yamt * Redistribution and use in source and binary forms, with or without
10 1.2.2.2 yamt * modification, are permitted provided that the following conditions
11 1.2.2.2 yamt * are met:
12 1.2.2.2 yamt * 1. Redistributions of source code must retain the above copyright
13 1.2.2.2 yamt * notice, this list of conditions and the following disclaimer.
14 1.2.2.2 yamt * 2. Redistributions in binary form must reproduce the above copyright
15 1.2.2.2 yamt * notice, this list of conditions and the following disclaimer in the
16 1.2.2.2 yamt * documentation and/or other materials provided with the distribution.
17 1.2.2.2 yamt * 3. All advertising materials mentioning features or use of this software
18 1.2.2.2 yamt * must display the abovementioned copyrights
19 1.2.2.2 yamt * 4. The name of the author may not be used to endorse or promote products
20 1.2.2.2 yamt * derived from this software without specific prior written permission
21 1.2.2.2 yamt *
22 1.2.2.2 yamt * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
23 1.2.2.2 yamt * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
24 1.2.2.2 yamt * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
25 1.2.2.2 yamt * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
26 1.2.2.2 yamt * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
27 1.2.2.2 yamt * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
28 1.2.2.2 yamt * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
29 1.2.2.2 yamt * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
30 1.2.2.2 yamt * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
31 1.2.2.2 yamt * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
32 1.2.2.2 yamt */
33 1.2.2.2 yamt
34 1.2.2.2 yamt #include <sys/cdefs.h>
35 1.2.2.3 yamt __KERNEL_RCSID(0, "$NetBSD: spx.c,v 1.2.2.3 2010/08/11 22:52:52 yamt Exp $");
36 1.2.2.2 yamt
37 1.2.2.2 yamt #include <sys/param.h>
38 1.2.2.2 yamt #include <sys/device.h>
39 1.2.2.2 yamt #include <sys/systm.h>
40 1.2.2.2 yamt #include <sys/callout.h>
41 1.2.2.2 yamt #include <sys/time.h>
42 1.2.2.2 yamt #include <sys/malloc.h>
43 1.2.2.2 yamt #include <sys/conf.h>
44 1.2.2.2 yamt #include <sys/kernel.h>
45 1.2.2.2 yamt
46 1.2.2.2 yamt #include <uvm/uvm.h>
47 1.2.2.2 yamt
48 1.2.2.2 yamt #include <machine/vsbus.h>
49 1.2.2.2 yamt #include <machine/sid.h>
50 1.2.2.2 yamt #include <machine/cpu.h>
51 1.2.2.2 yamt #include <machine/ka420.h>
52 1.2.2.2 yamt
53 1.2.2.2 yamt #include <dev/cons.h>
54 1.2.2.2 yamt
55 1.2.2.2 yamt #include <dev/dec/dzreg.h>
56 1.2.2.2 yamt #include <dev/dec/dzvar.h>
57 1.2.2.2 yamt #include <dev/dec/dzkbdvar.h>
58 1.2.2.2 yamt
59 1.2.2.2 yamt #include <dev/wscons/wsdisplayvar.h>
60 1.2.2.2 yamt #include <dev/wscons/wsconsio.h>
61 1.2.2.2 yamt #include <dev/wscons/wscons_callbacks.h>
62 1.2.2.2 yamt #include <dev/wsfont/wsfont.h>
63 1.2.2.2 yamt
64 1.2.2.2 yamt #include "machine/scb.h"
65 1.2.2.2 yamt
66 1.2.2.2 yamt #include "dzkbd.h"
67 1.2.2.2 yamt
68 1.2.2.2 yamt #define CONF_LCSPX 0x02
69 1.2.2.2 yamt #define CONF_SPXg 0x10
70 1.2.2.2 yamt
71 1.2.2.2 yamt #define FB_IS_SPX 1
72 1.2.2.2 yamt #define FB_IS_SPXg 2
73 1.2.2.2 yamt
74 1.2.2.2 yamt /* Screen hardware defs */
75 1.2.2.2 yamt #define SPX_FB_ADDR 0x38000000 /* Frame buffer */
76 1.2.2.2 yamt #define SPXg_FB_ADDR_KA46 0x22200000
77 1.2.2.2 yamt #define SPXg_FB_ADDR_KA49 0x28200000
78 1.2.2.2 yamt #define SPXg_FB_ADDR ((vax_boardtype == VAX_BTYP_46) ? \
79 1.2.2.2 yamt SPXg_FB_ADDR_KA46 : SPXg_FB_ADDR_KA49)
80 1.2.2.2 yamt
81 1.2.2.2 yamt #define SPXg_WIN_SIZE 0x00100000 /* Window size */
82 1.2.2.2 yamt /* # of pixels that fit into single window */
83 1.2.2.2 yamt #define SPXg_WIN_LINEAR (SPXg_WIN_SIZE / 2)
84 1.2.2.2 yamt
85 1.2.2.2 yamt #define SPXg_DELAY 5
86 1.2.2.2 yamt
87 1.2.2.2 yamt /*
88 1.2.2.2 yamt * off-screen font storage space
89 1.2.2.3 yamt * 32x16 glyphs, 256 regular and underlined chars
90 1.2.2.2 yamt */
91 1.2.2.2 yamt #define FONT_STORAGE_START (spx_xsize * spx_ysize)
92 1.2.2.2 yamt #define FONT_STORAGE_SIZE (32 * 16 * 256 * 2)
93 1.2.2.2 yamt
94 1.2.2.2 yamt /* register space defines */
95 1.2.2.2 yamt #define SPX_REG_SIZE 0x00002000
96 1.2.2.2 yamt #define SPX_REG_ADDR 0x39302000 /* 1st set of SPX registers */
97 1.2.2.2 yamt
98 1.2.2.2 yamt #define SPXg_REG_SIZE 0x00004000
99 1.2.2.2 yamt #define SPXg_REG_ADDR_KA46 0x22004000
100 1.2.2.2 yamt #define SPXg_REG_ADDR_KA49 0x28004000
101 1.2.2.2 yamt #define SPXg_REG_ADDR ((vax_boardtype == VAX_BTYP_46) ? \
102 1.2.2.2 yamt SPXg_REG_ADDR_KA46 : SPXg_REG_ADDR_KA49)
103 1.2.2.2 yamt
104 1.2.2.2 yamt #define SPX_REG1_SIZE 0x00001000
105 1.2.2.2 yamt #define SPX_REG1_ADDR 0x39b00000 /* 2nd set of SPX registers */
106 1.2.2.2 yamt
107 1.2.2.2 yamt #define SPXg_REG1_SIZE 0x00001000
108 1.2.2.2 yamt #define SPXg_REG1_ADDR_KA46 0x22100000
109 1.2.2.2 yamt #define SPXg_REG1_ADDR_KA49 0x28100000
110 1.2.2.2 yamt #define SPXg_REG1_ADDR ((vax_boardtype == VAX_BTYP_46) ? \
111 1.2.2.2 yamt SPXg_REG1_ADDR_KA46 : SPXg_REG1_ADDR_KA49)
112 1.2.2.2 yamt #define SPX_REG(reg) regaddr[(reg - 0x2000) / 4]
113 1.2.2.2 yamt #define SPXg_REG(reg) regaddr[(reg - 0x2000) / 2]
114 1.2.2.2 yamt
115 1.2.2.2 yamt #define SPX_REG1(reg) regaddr1[(reg) / 4]
116 1.2.2.2 yamt #define SPXg_REG1(reg) regaddr1[(reg) / 4]
117 1.2.2.2 yamt
118 1.2.2.2 yamt /* few SPX register names */
119 1.2.2.2 yamt #define SPX_COMMAND 0x21ec
120 1.2.2.2 yamt #define SPX_XSTART 0x21d0
121 1.2.2.2 yamt #define SPX_YSTART 0x21d4
122 1.2.2.2 yamt #define SPX_XEND 0x21d8
123 1.2.2.2 yamt #define SPX_YEND 0x21dc
124 1.2.2.2 yamt #define SPX_DSTPIX 0x21e0
125 1.2.2.2 yamt #define SPX_DSTPIX1 0x20e0
126 1.2.2.2 yamt #define SPX_SRCPIX 0x21e4
127 1.2.2.2 yamt #define SPX_SRCPIX1 0x20e4
128 1.2.2.2 yamt #define SPX_MAIN3 0x219c
129 1.2.2.2 yamt #define SPX_STRIDE 0x21e8 /* SRC | DST */
130 1.2.2.2 yamt #define SPX_SRCMASK 0x21f0
131 1.2.2.2 yamt #define SPX_DSTMASK 0x21f4
132 1.2.2.2 yamt #define SPX_FG 0x2260
133 1.2.2.2 yamt #define SPX_BG 0x2264
134 1.2.2.2 yamt #define SPX_DESTLOOP 0x2270
135 1.2.2.2 yamt #define SPX_MPC 0x21fc
136 1.2.2.2 yamt
137 1.2.2.2 yamt /* few SPX opcodes (microcode entry points); rasterop # = opcode ? */
138 1.2.2.2 yamt #define SPX_OP_FILLRECT 0x19
139 1.2.2.2 yamt #define SPX_OP_COPYRECT 0x1a
140 1.2.2.2 yamt
141 1.2.2.2 yamt /* bt459 locations */
142 1.2.2.2 yamt #define SPX_BT459_ADDRL 0x39b10000
143 1.2.2.2 yamt #define SPX_BT459_ADDRH 0x39b14000
144 1.2.2.2 yamt #define SPX_BT459_REG 0x39b18000
145 1.2.2.2 yamt #define SPX_BT459_CMAP 0x39b1c000
146 1.2.2.2 yamt
147 1.2.2.2 yamt /* bt460 locations */
148 1.2.2.2 yamt #define SPXg_BT460_BASE_KA46 0x200f0000
149 1.2.2.2 yamt #define SPXg_BT460_BASE_KA49 0x2a000000
150 1.2.2.2 yamt #define SPXg_BT460_BASE ((vax_boardtype == VAX_BTYP_46) ? \
151 1.2.2.2 yamt SPXg_BT460_BASE_KA46 : SPXg_BT460_BASE_KA49)
152 1.2.2.2 yamt
153 1.2.2.2 yamt #define SPX_BG_COLOR WS_DEFAULT_BG
154 1.2.2.2 yamt #define SPX_FG_COLOR WS_DEFAULT_FG
155 1.2.2.2 yamt
156 1.2.2.2 yamt /*
157 1.2.2.2 yamt * cursor X = 0, Y = 0 on-screen bias
158 1.2.2.2 yamt * FIXME: BIAS for various HW types
159 1.2.2.2 yamt */
160 1.2.2.2 yamt #define CUR_XBIAS 360
161 1.2.2.2 yamt #define CUR_YBIAS 37
162 1.2.2.2 yamt
163 1.2.2.2 yamt /* few BT459 & BT460 indirect register defines */
164 1.2.2.2 yamt #define SPXDAC_REG_CCOLOR_1 0x181
165 1.2.2.2 yamt #define SPXDAC_REG_CCOLOR_2 0x182
166 1.2.2.2 yamt #define SPXDAC_REG_CCOLOR_3 0x183
167 1.2.2.2 yamt #define SPXDAC_REG_ID 0x200
168 1.2.2.2 yamt #define SPXDAC_REG_CMD0 0x201
169 1.2.2.2 yamt #define SPXDAC_REG_CMD1 0x202
170 1.2.2.2 yamt #define SPXDAC_REG_CMD2 0x203
171 1.2.2.2 yamt #define SPXDAC_REG_PRM 0x204
172 1.2.2.2 yamt #define SPXDAC_REG_CCR 0x300
173 1.2.2.2 yamt #define SPXDAC_REG_CXLO 0x301
174 1.2.2.2 yamt #define SPXDAC_REG_CXHI 0x302
175 1.2.2.2 yamt #define SPXDAC_REG_CYLO 0x303
176 1.2.2.2 yamt #define SPXDAC_REG_CYHI 0x304
177 1.2.2.2 yamt #define SPXDAC_REG_WXLO 0x305
178 1.2.2.2 yamt #define SPXDAC_REG_WXHI 0x306
179 1.2.2.2 yamt #define SPXDAC_REG_WYLO 0x307
180 1.2.2.2 yamt #define SPXDAC_REG_WYHI 0x308
181 1.2.2.2 yamt #define SPXDAC_REG_WWLO 0x309
182 1.2.2.2 yamt #define SPXDAC_REG_WWHI 0x30a
183 1.2.2.2 yamt #define SPXDAC_REG_WHLO 0x30b
184 1.2.2.2 yamt #define SPXDAC_REG_WHHI 0x30c
185 1.2.2.2 yamt #define SPXDAC_REG_CRAM_BASE 0x400
186 1.2.2.2 yamt
187 1.2.2.2 yamt /*
188 1.2.2.2 yamt * used to access top/bottom 8 bits of a 16-bit argument for split RAMDAC
189 1.2.2.2 yamt * addressing
190 1.2.2.2 yamt */
191 1.2.2.2 yamt #define HI(x) (((x) >> 8) & 0xff)
192 1.2.2.2 yamt #define LO(x) ((x) & 0xff)
193 1.2.2.2 yamt
194 1.2.2.2 yamt static int spx_match(device_t, cfdata_t, void *);
195 1.2.2.2 yamt static void spx_attach(device_t, device_t, void *);
196 1.2.2.2 yamt
197 1.2.2.2 yamt struct spx_softc {
198 1.2.2.2 yamt device_t ss_dev;
199 1.2.2.2 yamt };
200 1.2.2.2 yamt
201 1.2.2.2 yamt CFATTACH_DECL_NEW(spx, sizeof(struct spx_softc),
202 1.2.2.2 yamt spx_match, spx_attach, NULL, NULL);
203 1.2.2.2 yamt
204 1.2.2.2 yamt static void spx_cursor(void *, int, int, int);
205 1.2.2.2 yamt static int spx_mapchar(void *, int, unsigned int *);
206 1.2.2.2 yamt static void spx_putchar(void *, int, int, u_int, long);
207 1.2.2.3 yamt static void spx_copycols(void *, int, int, int, int);
208 1.2.2.2 yamt static void spx_erasecols(void *, int, int, int, long);
209 1.2.2.2 yamt static void spx_copyrows(void *, int, int, int);
210 1.2.2.2 yamt static void spx_eraserows(void *, int, int, long);
211 1.2.2.2 yamt static int spx_allocattr(void *, int, int, int, long *);
212 1.2.2.2 yamt static int spx_get_cmap(struct wsdisplay_cmap *);
213 1.2.2.2 yamt static int spx_set_cmap(struct wsdisplay_cmap *);
214 1.2.2.2 yamt
215 1.2.2.2 yamt static int spx_map_regs(device_t, u_int, u_int, u_int, u_int);
216 1.2.2.2 yamt static void SPX_render_font(void);
217 1.2.2.2 yamt static void SPXg_render_font(void);
218 1.2.2.2 yamt static int SPX_map_fb(device_t, struct vsbus_attach_args *);
219 1.2.2.2 yamt static int SPXg_map_fb(device_t, struct vsbus_attach_args *);
220 1.2.2.2 yamt static void spx_init_common(device_t, struct vsbus_attach_args *);
221 1.2.2.2 yamt
222 1.2.2.2 yamt #define SPX_MAP_FB(self, va, type) if (! type ## _map_fb(self, va)) return
223 1.2.2.2 yamt #define SPX_MAP_REGS(self, type) if (!spx_map_regs(self, \
224 1.2.2.2 yamt type ## _REG_ADDR, \
225 1.2.2.2 yamt type ## _REG_SIZE, \
226 1.2.2.2 yamt type ## _REG1_ADDR, \
227 1.2.2.2 yamt type ## _REG1_SIZE)) \
228 1.2.2.2 yamt return
229 1.2.2.2 yamt
230 1.2.2.2 yamt const struct wsdisplay_emulops spx_emulops = {
231 1.2.2.2 yamt spx_cursor,
232 1.2.2.2 yamt spx_mapchar,
233 1.2.2.2 yamt spx_putchar,
234 1.2.2.2 yamt spx_copycols,
235 1.2.2.2 yamt spx_erasecols,
236 1.2.2.2 yamt spx_copyrows,
237 1.2.2.2 yamt spx_eraserows,
238 1.2.2.2 yamt spx_allocattr
239 1.2.2.2 yamt };
240 1.2.2.2 yamt
241 1.2.2.2 yamt static char spx_stdscreen_name[10] = "160x128";
242 1.2.2.2 yamt struct wsscreen_descr spx_stdscreen = {
243 1.2.2.2 yamt spx_stdscreen_name, 160, 128, /* dynamically set */
244 1.2.2.2 yamt &spx_emulops,
245 1.2.2.2 yamt 8, 15, /* dynamically set */
246 1.2.2.2 yamt WSSCREEN_UNDERLINE|WSSCREEN_REVERSE|WSSCREEN_WSCOLORS,
247 1.2.2.2 yamt };
248 1.2.2.2 yamt
249 1.2.2.2 yamt const struct wsscreen_descr *_spx_scrlist[] = {
250 1.2.2.2 yamt &spx_stdscreen,
251 1.2.2.2 yamt };
252 1.2.2.2 yamt
253 1.2.2.2 yamt const struct wsscreen_list spx_screenlist = {
254 1.2.2.2 yamt sizeof(_spx_scrlist) / sizeof(struct wsscreen_descr *),
255 1.2.2.2 yamt _spx_scrlist,
256 1.2.2.2 yamt };
257 1.2.2.2 yamt
258 1.2.2.2 yamt static volatile char *spxaddr;
259 1.2.2.2 yamt static volatile long *regaddr;
260 1.2.2.2 yamt static volatile long *regaddr1;
261 1.2.2.2 yamt
262 1.2.2.2 yamt static volatile char *bt_addrl;
263 1.2.2.2 yamt static volatile char *bt_addrh;
264 1.2.2.2 yamt static volatile char *bt_reg;
265 1.2.2.2 yamt static volatile char *bt_cmap;
266 1.2.2.2 yamt static volatile char *bt_wait; /* SPXg/gt only */
267 1.2.2.2 yamt
268 1.2.2.2 yamt static int spx_xsize;
269 1.2.2.2 yamt static int spx_ysize;
270 1.2.2.2 yamt static int spx_depth;
271 1.2.2.2 yamt static int spx_cols;
272 1.2.2.2 yamt static int spx_rows;
273 1.2.2.2 yamt static long spx_fb_size;
274 1.2.2.2 yamt
275 1.2.2.2 yamt /* Our current hardware colormap */
276 1.2.2.2 yamt static struct hwcmap256 {
277 1.2.2.2 yamt #define CMAP_SIZE 256 /* 256 R/G/B entries */
278 1.2.2.2 yamt u_int8_t r[CMAP_SIZE];
279 1.2.2.2 yamt u_int8_t g[CMAP_SIZE];
280 1.2.2.2 yamt u_int8_t b[CMAP_SIZE];
281 1.2.2.2 yamt } spx_cmap;
282 1.2.2.2 yamt
283 1.2.2.2 yamt /* The default colormap */
284 1.2.2.2 yamt static struct {
285 1.2.2.2 yamt u_int8_t r[8];
286 1.2.2.2 yamt u_int8_t g[8];
287 1.2.2.2 yamt u_int8_t b[8];
288 1.2.2.2 yamt } spx_default_cmap = {
289 1.2.2.2 yamt { 0x00, 0xff, 0x00, 0xff, 0x00, 0xff, 0x00, 0xff },
290 1.2.2.2 yamt { 0x00, 0x00, 0xff, 0x7f, 0x00, 0x00, 0xff, 0xff },
291 1.2.2.2 yamt { 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0xff, 0xff }
292 1.2.2.2 yamt };
293 1.2.2.2 yamt
294 1.2.2.2 yamt static char fb_type = 0;
295 1.2.2.2 yamt static char spxg_current_page = 0;
296 1.2.2.2 yamt #define spxg_switch_page(nr) (SPXg_REG1(0x20) = ((1 << (nr) & 0xff)) << 16)
297 1.2.2.2 yamt
298 1.2.2.2 yamt struct wsdisplay_font spx_font;
299 1.2.2.2 yamt static u_char *qf;
300 1.2.2.2 yamt static u_short *qf2;
301 1.2.2.2 yamt
302 1.2.2.2 yamt #define QCHAR_INVALID(c) (((c) < spx_font.firstchar) || \
303 1.2.2.2 yamt ((c) >= spx_font.firstchar + spx_font.numchars))
304 1.2.2.2 yamt #define QCHAR(c) (QCHAR_INVALID(c) ? 0 : (c) - spx_font.firstchar)
305 1.2.2.2 yamt
306 1.2.2.2 yamt #define QFONT_INDEX(c, line) (QCHAR(c) * spx_font.fontheight + line)
307 1.2.2.2 yamt #define QFONT_QF(c, line) qf[QFONT_INDEX(c, line)]
308 1.2.2.2 yamt #define QFONT_QF2(c, line) qf2[QFONT_INDEX(c, line)]
309 1.2.2.2 yamt #define QFONT(c, line) (spx_font.stride == 2 ? \
310 1.2.2.2 yamt QFONT_QF2(c, line) : \
311 1.2.2.2 yamt QFONT_QF(c, line))
312 1.2.2.2 yamt
313 1.2.2.2 yamt /* replicate color value */
314 1.2.2.2 yamt #define COLOR(x) (((x) << 24) | ((x) << 16) | ((x) << 8) | (x))
315 1.2.2.2 yamt
316 1.2.2.2 yamt /* convert coordinates into linear offset */
317 1.2.2.2 yamt #define LINEAR(x, y) ((y * spx_xsize) + x)
318 1.2.2.2 yamt
319 1.2.2.2 yamt /* Linear pixel address */
320 1.2.2.2 yamt #define SPX_POS(row, col, line, dot) \
321 1.2.2.2 yamt ((col) * spx_font.fontwidth + \
322 1.2.2.2 yamt (row) * spx_font.fontheight * spx_xsize + \
323 1.2.2.2 yamt (line) * spx_xsize + dot)
324 1.2.2.2 yamt
325 1.2.2.2 yamt #define SPX_ADDR(row, col, line, dot) spxaddr[SPX_POS(row, col, line, dot)]
326 1.2.2.2 yamt
327 1.2.2.2 yamt /* Recalculate absolute pixel address from linear address */
328 1.2.2.2 yamt #define SPXg_ADDR(linear) spxaddr[((((linear) % SPXg_WIN_LINEAR) / 4) * 8) + \
329 1.2.2.2 yamt (((linear) % SPXg_WIN_LINEAR) % 4)]
330 1.2.2.2 yamt
331 1.2.2.2 yamt
332 1.2.2.2 yamt static int spx_ioctl(void *, void *, u_long, void *, int, struct lwp *);
333 1.2.2.2 yamt static paddr_t spx_mmap(void *, void *, off_t, int);
334 1.2.2.2 yamt static int spx_alloc_screen(void *, const struct wsscreen_descr *,
335 1.2.2.2 yamt void **, int *, int *, long *);
336 1.2.2.2 yamt static void spx_free_screen(void *, void *);
337 1.2.2.2 yamt static int spx_show_screen(void *, void *, int, void (*) (void *, int, int),
338 1.2.2.2 yamt void *);
339 1.2.2.2 yamt
340 1.2.2.2 yamt static void spx_update_cmap(int entry, char red, char green, char blue);
341 1.2.2.2 yamt static void set_btreg(u_int addr, u_char value);
342 1.2.2.2 yamt static u_char get_btreg(u_int addr);
343 1.2.2.2 yamt
344 1.2.2.2 yamt /* SPXg/gt delay */
345 1.2.2.2 yamt static void spxg_delay(void);
346 1.2.2.2 yamt
347 1.2.2.2 yamt /*
348 1.2.2.2 yamt * SPX HW accelerated block copy
349 1.2.2.2 yamt * common code in spx_blkcpy,
350 1.2.2.2 yamt * HW-specific code accessed through spx_blkcpy_func pointer
351 1.2.2.2 yamt */
352 1.2.2.2 yamt static void spx_blkcpy(u_int sxpos, u_int sypos,
353 1.2.2.2 yamt u_int dxpos, u_int dypos,
354 1.2.2.2 yamt u_int xdim, u_int ydim);
355 1.2.2.2 yamt
356 1.2.2.2 yamt static void SPX_blkcpy(u_int sxpos, u_int sypos,
357 1.2.2.2 yamt u_int dxpos, u_int dypos,
358 1.2.2.2 yamt u_int xdim, u_int ydim,
359 1.2.2.2 yamt char direction);
360 1.2.2.2 yamt static void SPXg_blkcpy(u_int sxpos, u_int sypos,
361 1.2.2.2 yamt u_int dxpos, u_int dypos,
362 1.2.2.2 yamt u_int xdim, u_int ydim,
363 1.2.2.2 yamt char direction);
364 1.2.2.2 yamt static void (*spx_blkcpy_func)(u_int, u_int,
365 1.2.2.2 yamt u_int, u_int,
366 1.2.2.2 yamt u_int, u_int,
367 1.2.2.2 yamt char);
368 1.2.2.2 yamt
369 1.2.2.2 yamt /* SPX HW accelerated block set, no common code */
370 1.2.2.2 yamt static void SPX_blkset(u_int xpos, u_int ypos,
371 1.2.2.2 yamt u_int xdim, u_int ydim, char color);
372 1.2.2.2 yamt static void SPXg_blkset(u_int xpos, u_int ypos,
373 1.2.2.2 yamt u_int xdim, u_int ydim, char color);
374 1.2.2.2 yamt static void (*spx_blkset_func)(u_int, u_int, u_int, u_int, char);
375 1.2.2.2 yamt #define spx_blkset(x, y, xd, yd, c) spx_blkset_func(x, y, xd, yd, c)
376 1.2.2.2 yamt
377 1.2.2.2 yamt /* SPX HW accelerated part of spx_putchar */
378 1.2.2.2 yamt static void SPX_putchar(int, int, u_int, char, char);
379 1.2.2.2 yamt static void SPXg_putchar(int, int, u_int, char, char);
380 1.2.2.2 yamt static void (*spx_putchar_func)(int, int, u_int, char, char);
381 1.2.2.2 yamt
382 1.2.2.2 yamt const struct wsdisplay_accessops spx_accessops = {
383 1.2.2.2 yamt spx_ioctl,
384 1.2.2.2 yamt spx_mmap,
385 1.2.2.2 yamt spx_alloc_screen,
386 1.2.2.2 yamt spx_free_screen,
387 1.2.2.2 yamt spx_show_screen,
388 1.2.2.2 yamt 0 /* load_font */
389 1.2.2.2 yamt };
390 1.2.2.2 yamt
391 1.2.2.2 yamt /* TODO allocate ss_image dynamically for consoles beyond first one */
392 1.2.2.2 yamt struct spx_screen {
393 1.2.2.2 yamt int ss_curx;
394 1.2.2.2 yamt int ss_cury;
395 1.2.2.2 yamt int ss_cur_fg;
396 1.2.2.2 yamt int ss_cur_bg;
397 1.2.2.2 yamt struct {
398 1.2.2.2 yamt u_char data; /* Image character */
399 1.2.2.2 yamt u_char attr; /* Attribute: 80/70/08/07 */
400 1.2.2.2 yamt } ss_image[160 * 128]; /* allow for maximum possible cell matrix */
401 1.2.2.2 yamt };
402 1.2.2.2 yamt
403 1.2.2.2 yamt #define SPX_ATTR_UNDERLINE 0x80
404 1.2.2.2 yamt #define SPX_BG_MASK 0x70
405 1.2.2.2 yamt #define SPX_ATTR_REVERSE 0x08
406 1.2.2.2 yamt #define SPX_FG_MASK 0x07
407 1.2.2.2 yamt
408 1.2.2.2 yamt static struct spx_screen spx_conscreen;
409 1.2.2.2 yamt static struct spx_screen *prevscr, *curscr;
410 1.2.2.2 yamt static struct spx_screen *savescr;
411 1.2.2.2 yamt
412 1.2.2.2 yamt static int cur_fg, cur_bg;
413 1.2.2.2 yamt static int spx_off = 1;
414 1.2.2.2 yamt
415 1.2.2.2 yamt static void
416 1.2.2.2 yamt spx_update_cmap(int entry, char red, char green, char blue)
417 1.2.2.2 yamt {
418 1.2.2.2 yamt *bt_addrl = LO(entry);
419 1.2.2.2 yamt *bt_addrh = HI(entry);
420 1.2.2.2 yamt if ((entry >= 0x181) && (entry <= 0x183)) {
421 1.2.2.2 yamt *bt_reg = red;
422 1.2.2.2 yamt *bt_reg = green;
423 1.2.2.2 yamt *bt_reg = blue;
424 1.2.2.2 yamt } else {
425 1.2.2.2 yamt *bt_cmap = red;
426 1.2.2.2 yamt *bt_cmap = green;
427 1.2.2.2 yamt *bt_cmap = blue;
428 1.2.2.2 yamt }
429 1.2.2.2 yamt }
430 1.2.2.2 yamt
431 1.2.2.2 yamt static void
432 1.2.2.2 yamt set_btreg(u_int addr, u_char value)
433 1.2.2.2 yamt {
434 1.2.2.2 yamt *bt_addrl = LO(addr);
435 1.2.2.2 yamt *bt_addrh = HI(addr);
436 1.2.2.2 yamt *bt_reg = value;
437 1.2.2.2 yamt }
438 1.2.2.2 yamt
439 1.2.2.2 yamt static u_char
440 1.2.2.2 yamt get_btreg(u_int addr)
441 1.2.2.2 yamt {
442 1.2.2.2 yamt *bt_addrl = LO(addr);
443 1.2.2.2 yamt *bt_addrh = HI(addr);
444 1.2.2.2 yamt return *bt_reg & 0xff;
445 1.2.2.2 yamt }
446 1.2.2.2 yamt
447 1.2.2.2 yamt static void
448 1.2.2.2 yamt spxg_delay(void)
449 1.2.2.2 yamt {
450 1.2.2.2 yamt char i;
451 1.2.2.2 yamt
452 1.2.2.2 yamt for (i = 0; i <= SPXg_DELAY; i++)
453 1.2.2.2 yamt *bt_wait = *bt_wait + i;
454 1.2.2.2 yamt }
455 1.2.2.2 yamt
456 1.2.2.2 yamt static void
457 1.2.2.2 yamt SPX_blkcpy(u_int sxpos, u_int sypos,
458 1.2.2.2 yamt u_int dxpos, u_int dypos,
459 1.2.2.2 yamt u_int xdim, u_int ydim,
460 1.2.2.2 yamt char direction)
461 1.2.2.2 yamt {
462 1.2.2.2 yamt u_int counter = 0xffffe;
463 1.2.2.2 yamt long temp = 0;
464 1.2.2.2 yamt
465 1.2.2.2 yamt SPX_REG(SPX_COMMAND) = 0x84884648 | direction; /* 0x848c4648? */
466 1.2.2.2 yamt SPX_REG(SPX_XSTART) = dxpos << 16;
467 1.2.2.2 yamt SPX_REG(SPX_YSTART) = dypos << 16;
468 1.2.2.2 yamt SPX_REG(SPX_XEND) = (dxpos + xdim) << 16;
469 1.2.2.2 yamt SPX_REG(SPX_YEND) = (dypos + ydim) << 16;
470 1.2.2.2 yamt
471 1.2.2.2 yamt temp = ((SPX_REG1(0x10) & 0xc0) << (30 - 6)) | \
472 1.2.2.2 yamt ((SPX_REG1(0x10) & 0x3f) << 24);
473 1.2.2.2 yamt
474 1.2.2.2 yamt SPX_REG(SPX_DSTPIX) = temp + LINEAR(dxpos, dypos);
475 1.2.2.2 yamt SPX_REG(SPX_SRCPIX) = temp + LINEAR(sxpos, sypos);
476 1.2.2.2 yamt SPX_REG(SPX_SRCPIX1) = 0;
477 1.2.2.2 yamt SPX_REG(SPX_STRIDE) = (spx_xsize << 16) | spx_xsize;
478 1.2.2.2 yamt SPX_REG(SPX_SRCMASK) = 0xff;
479 1.2.2.2 yamt SPX_REG(SPX_DSTMASK) = 0xff;
480 1.2.2.2 yamt
481 1.2.2.2 yamt SPX_REG(SPX_DESTLOOP) = 0x00112003;
482 1.2.2.2 yamt SPX_REG(SPX_MPC) = 0x2000 | SPX_OP_COPYRECT;
483 1.2.2.2 yamt
484 1.2.2.2 yamt SPX_REG1(0x18) = 0xffffffff;
485 1.2.2.2 yamt while ((counter) && ((SPX_REG1(0x18) & 2) == 0))
486 1.2.2.2 yamt counter--;
487 1.2.2.2 yamt }
488 1.2.2.2 yamt
489 1.2.2.2 yamt static void
490 1.2.2.2 yamt SPXg_blkcpy(u_int sxpos, u_int sypos,
491 1.2.2.2 yamt u_int dxpos, u_int dypos,
492 1.2.2.2 yamt u_int xdim, u_int ydim,
493 1.2.2.2 yamt char direction)
494 1.2.2.2 yamt {
495 1.2.2.2 yamt u_int counter = 0xffffe;
496 1.2.2.2 yamt long temp = 0;
497 1.2.2.2 yamt
498 1.2.2.2 yamt SPXg_REG(SPX_COMMAND) = 0x84884648 | direction; spxg_delay();
499 1.2.2.2 yamt SPXg_REG(SPX_XSTART) = dxpos << 16; spxg_delay();
500 1.2.2.2 yamt SPXg_REG(SPX_YSTART) = dypos << 16; spxg_delay();
501 1.2.2.2 yamt SPXg_REG(SPX_XEND) = (dxpos + xdim) << 16; spxg_delay();
502 1.2.2.2 yamt SPXg_REG(SPX_YEND) = (dypos + ydim) << 16; spxg_delay();
503 1.2.2.2 yamt
504 1.2.2.2 yamt temp = 0x3f << 24;
505 1.2.2.2 yamt
506 1.2.2.2 yamt SPXg_REG(SPX_DSTPIX) = temp + LINEAR(dxpos, dypos); spxg_delay();
507 1.2.2.2 yamt SPXg_REG(SPX_DSTPIX1) = 0xff000000; spxg_delay();
508 1.2.2.2 yamt SPXg_REG(SPX_SRCPIX) = temp + LINEAR(sxpos, sypos); spxg_delay();
509 1.2.2.2 yamt SPXg_REG(SPX_SRCPIX1) = 0; spxg_delay();
510 1.2.2.2 yamt SPXg_REG(SPX_STRIDE) = (spx_xsize << 16) | spx_xsize; spxg_delay();
511 1.2.2.2 yamt SPXg_REG(SPX_SRCMASK) = 0xffffffff; spxg_delay();
512 1.2.2.2 yamt SPXg_REG(SPX_DSTMASK) = 0xffffffff; spxg_delay();
513 1.2.2.2 yamt
514 1.2.2.2 yamt SPXg_REG(SPX_DESTLOOP) = 0x00112003; spxg_delay();
515 1.2.2.2 yamt SPXg_REG(SPX_MPC) = 0x2000 | SPX_OP_COPYRECT; spxg_delay();
516 1.2.2.2 yamt
517 1.2.2.2 yamt while ((counter) && ((SPXg_REG1(0x0) & 0x8000) == 0))
518 1.2.2.2 yamt counter--;
519 1.2.2.2 yamt }
520 1.2.2.2 yamt
521 1.2.2.2 yamt static void
522 1.2.2.2 yamt spx_blkcpy(u_int sxpos, u_int sypos,
523 1.2.2.2 yamt u_int dxpos, u_int dypos,
524 1.2.2.2 yamt u_int xdim, u_int ydim)
525 1.2.2.2 yamt {
526 1.2.2.2 yamt char direction = 0;
527 1.2.2.2 yamt
528 1.2.2.2 yamt /* don't waste time checking whether src and dest actually overlap */
529 1.2.2.2 yamt if (sxpos < dxpos) {
530 1.2.2.2 yamt direction |= 0x01; /* X decrement */
531 1.2.2.2 yamt sxpos += xdim;
532 1.2.2.2 yamt dxpos += xdim;
533 1.2.2.2 yamt xdim = -xdim;
534 1.2.2.2 yamt }
535 1.2.2.2 yamt if (sypos < dypos) {
536 1.2.2.2 yamt direction |= 0x02; /* Y decrement */
537 1.2.2.2 yamt sypos += ydim;
538 1.2.2.2 yamt dypos += ydim;
539 1.2.2.2 yamt ydim = -ydim;
540 1.2.2.2 yamt }
541 1.2.2.2 yamt
542 1.2.2.2 yamt spx_blkcpy_func(sxpos, sypos, dxpos, dypos, xdim, ydim, direction);
543 1.2.2.2 yamt }
544 1.2.2.2 yamt
545 1.2.2.2 yamt static void
546 1.2.2.2 yamt SPX_blkset(u_int xpos, u_int ypos, u_int xdim, u_int ydim, char color)
547 1.2.2.2 yamt {
548 1.2.2.2 yamt u_int counter = 0xfffe;
549 1.2.2.2 yamt long temp = 0;
550 1.2.2.2 yamt
551 1.2.2.2 yamt SPX_REG(SPX_COMMAND) = 0x84884608;
552 1.2.2.2 yamt SPX_REG(SPX_XSTART) = xpos << 16;
553 1.2.2.2 yamt SPX_REG(SPX_YSTART) = ypos << 16;
554 1.2.2.2 yamt SPX_REG(SPX_XEND) = (xpos + xdim) << 16;
555 1.2.2.2 yamt SPX_REG(SPX_YEND) = (ypos + ydim) << 16;
556 1.2.2.2 yamt SPX_REG(SPX_STRIDE) = (spx_xsize << 16) | spx_xsize;
557 1.2.2.2 yamt SPX_REG(SPX_DESTLOOP) = 0x20102003;
558 1.2.2.2 yamt
559 1.2.2.2 yamt temp = ((SPX_REG1(0x10) & 0xc0) << (30 - 6)) |
560 1.2.2.2 yamt ((SPX_REG1(0x10) & 0x3f) << 24);
561 1.2.2.2 yamt SPX_REG(SPX_DSTPIX) = temp + LINEAR(xpos, ypos);
562 1.2.2.2 yamt
563 1.2.2.2 yamt SPX_REG(SPX_FG) = COLOR(color);
564 1.2.2.2 yamt
565 1.2.2.2 yamt SPX_REG(SPX_MPC) = 0x2000 | SPX_OP_FILLRECT;
566 1.2.2.2 yamt
567 1.2.2.2 yamt SPX_REG1(0x18) = 0xffffffff;
568 1.2.2.2 yamt while ((counter) && ((SPX_REG1(0x18) & 2) == 0))
569 1.2.2.2 yamt counter--;
570 1.2.2.2 yamt }
571 1.2.2.2 yamt
572 1.2.2.2 yamt static void
573 1.2.2.2 yamt SPXg_blkset(u_int xpos, u_int ypos, u_int xdim, u_int ydim, char color)
574 1.2.2.2 yamt {
575 1.2.2.2 yamt u_int counter = 0xfffe;
576 1.2.2.2 yamt long temp = 0;
577 1.2.2.2 yamt
578 1.2.2.2 yamt SPXg_REG(SPX_COMMAND) = 0x84884608; spxg_delay();
579 1.2.2.2 yamt SPXg_REG(SPX_XSTART) = xpos << 16; spxg_delay();
580 1.2.2.2 yamt SPXg_REG(SPX_YSTART) = ypos << 16; spxg_delay();
581 1.2.2.2 yamt SPXg_REG(SPX_XEND) = (xpos + xdim) << 16; spxg_delay();
582 1.2.2.2 yamt SPXg_REG(SPX_YEND) = (ypos + ydim) << 16; spxg_delay();
583 1.2.2.2 yamt SPXg_REG(SPX_STRIDE) = (spx_xsize << 16) | spx_xsize; spxg_delay();
584 1.2.2.2 yamt
585 1.2.2.2 yamt temp = 0x3f << 24;
586 1.2.2.2 yamt SPXg_REG(SPX_DSTPIX) = temp + LINEAR(xpos, ypos); spxg_delay();
587 1.2.2.2 yamt SPXg_REG(SPX_DSTPIX1) = 0xff000000; spxg_delay();
588 1.2.2.2 yamt
589 1.2.2.2 yamt SPXg_REG(SPX_FG) = COLOR(color); spxg_delay();
590 1.2.2.2 yamt
591 1.2.2.2 yamt SPXg_REG(SPX_DESTLOOP) = 0x20102003; spxg_delay();
592 1.2.2.2 yamt SPXg_REG(SPX_MPC) = 0x2000 | SPX_OP_FILLRECT; spxg_delay();
593 1.2.2.2 yamt
594 1.2.2.2 yamt while ((counter) && ((SPXg_REG1(0x0) & 0x8000) == 0))
595 1.2.2.2 yamt counter--;
596 1.2.2.2 yamt }
597 1.2.2.2 yamt
598 1.2.2.3 yamt int
599 1.2.2.3 yamt spx_match(device_t parent, cfdata_t match, void *aux)
600 1.2.2.2 yamt {
601 1.2.2.2 yamt struct vsbus_softc *sc = device_private(parent);
602 1.2.2.2 yamt #if 0
603 1.2.2.2 yamt struct vsbus_attach_args *va = aux;
604 1.2.2.2 yamt char *ch = (char *)va->va_addr;
605 1.2.2.2 yamt #endif
606 1.2.2.2 yamt
607 1.2.2.2 yamt /*
608 1.2.2.2 yamt * FIXME:
609 1.2.2.2 yamt * add KA46 when/if ever somebody reports SPXg vax_confdata ID on VS 4000/60
610 1.2.2.2 yamt * Ditto for SPX ID on KA42 & KA43
611 1.2.2.2 yamt */
612 1.2.2.3 yamt if ((vax_boardtype != VAX_BTYP_49) ||
613 1.2.2.3 yamt ((vax_confdata & (CONF_LCSPX | CONF_SPXg)) == 0))
614 1.2.2.2 yamt return 0;
615 1.2.2.2 yamt
616 1.2.2.2 yamt /* FIXME add RAMDAC ID code ??? */
617 1.2.2.2 yamt #if 0
618 1.2.2.2 yamt /*
619 1.2.2.2 yamt * FIXME:
620 1.2.2.2 yamt * are memory addresses besides va->va_addr off limits at this time ?
621 1.2.2.2 yamt * RAMDAC ID register test, should read 0x4a for LCSPX, 0x4b for SPXg
622 1.2.2.2 yamt */
623 1.2.2.2 yamt if (get_btreg(SPXDAC_REG_ID) != 0x4a)
624 1.2.2.2 yamt return 0;
625 1.2.2.2 yamt #endif
626 1.2.2.2 yamt
627 1.2.2.2 yamt sc->sc_mask = 0x04; /* XXX - should be generated */
628 1.2.2.2 yamt scb_fake(0x14c, 0x15);
629 1.2.2.2 yamt
630 1.2.2.2 yamt return 20;
631 1.2.2.2 yamt }
632 1.2.2.2 yamt
633 1.2.2.2 yamt static void
634 1.2.2.2 yamt spx_attach(device_t parent, device_t self, void *aux)
635 1.2.2.2 yamt {
636 1.2.2.2 yamt struct spx_softc *sc = device_private(self);
637 1.2.2.2 yamt struct vsbus_attach_args *va = aux;
638 1.2.2.2 yamt struct wsemuldisplaydev_attach_args aa;
639 1.2.2.2 yamt
640 1.2.2.2 yamt sc->ss_dev = self;
641 1.2.2.2 yamt
642 1.2.2.2 yamt aprint_normal("\n");
643 1.2.2.2 yamt aa.console = spxaddr != NULL;
644 1.2.2.2 yamt
645 1.2.2.2 yamt spx_init_common(self, va);
646 1.2.2.2 yamt
647 1.2.2.3 yamt /* display FB type based on RAMDAC ID */
648 1.2.2.3 yamt switch (get_btreg(SPXDAC_REG_ID) & 0xff) {
649 1.2.2.3 yamt case 0x4a:
650 1.2.2.3 yamt aprint_normal_dev(self,
651 1.2.2.3 yamt "RAMDAC ID: 0x%x, Bt459 (SPX/LCSPX) RAMDAC type\n",
652 1.2.2.3 yamt get_btreg(SPXDAC_REG_ID) & 0xff);
653 1.2.2.3 yamt break;
654 1.2.2.3 yamt
655 1.2.2.3 yamt case 0x4b:
656 1.2.2.3 yamt aprint_normal_dev(self,
657 1.2.2.3 yamt "RAMDAC ID: 0x%x, Bt460 (SPXg) RAMDAC type\n",
658 1.2.2.3 yamt get_btreg(SPXDAC_REG_ID) & 0xff);
659 1.2.2.3 yamt break;
660 1.2.2.3 yamt default:
661 1.2.2.3 yamt aprint_error_dev(self, "unknown RAMDAC type 0x%x\n",
662 1.2.2.3 yamt get_btreg(SPXDAC_REG_ID) & 0xff);
663 1.2.2.3 yamt }
664 1.2.2.3 yamt
665 1.2.2.2 yamt curscr = &spx_conscreen;
666 1.2.2.2 yamt prevscr = curscr;
667 1.2.2.2 yamt
668 1.2.2.2 yamt aa.scrdata = &spx_screenlist;
669 1.2.2.2 yamt aa.accessops = &spx_accessops;
670 1.2.2.2 yamt
671 1.2.2.2 yamt /* enable cursor */
672 1.2.2.2 yamt set_btreg(SPXDAC_REG_CCR, 0xc1);
673 1.2.2.2 yamt
674 1.2.2.2 yamt config_found(self, &aa, wsemuldisplaydevprint);
675 1.2.2.2 yamt }
676 1.2.2.2 yamt
677 1.2.2.2 yamt static int cur_on;
678 1.2.2.2 yamt
679 1.2.2.2 yamt static void
680 1.2.2.2 yamt spx_cursor(void *id, int on, int row, int col)
681 1.2.2.2 yamt {
682 1.2.2.2 yamt struct spx_screen *ss = id;
683 1.2.2.2 yamt int attr, data;
684 1.2.2.2 yamt
685 1.2.2.2 yamt attr = ss->ss_image[row * spx_cols + col].attr;
686 1.2.2.2 yamt data = ss->ss_image[row * spx_cols + col].data;
687 1.2.2.2 yamt
688 1.2.2.2 yamt if (attr & SPX_ATTR_REVERSE) {
689 1.2.2.2 yamt cur_bg = attr & SPX_FG_MASK;
690 1.2.2.2 yamt cur_fg = (attr & SPX_BG_MASK) >> 4;
691 1.2.2.2 yamt } else {
692 1.2.2.2 yamt cur_fg = attr & SPX_FG_MASK;
693 1.2.2.2 yamt cur_bg = (attr & SPX_BG_MASK) >> 4;
694 1.2.2.2 yamt }
695 1.2.2.2 yamt
696 1.2.2.2 yamt if (ss == curscr) {
697 1.2.2.2 yamt #ifdef SOFTCURSOR
698 1.2.2.2 yamt if ((cur_on = on))
699 1.2.2.2 yamt spx_putchar_func(row, col, data, cur_bg, cur_fg);
700 1.2.2.2 yamt else
701 1.2.2.2 yamt spx_putchar_func(row, col, data, cur_fg, cur_bg);
702 1.2.2.2 yamt #else
703 1.2.2.2 yamt /* change cursor foreground color colormap entry */
704 1.2.2.2 yamt spx_update_cmap(SPXDAC_REG_CCOLOR_3,
705 1.2.2.2 yamt spx_cmap.r[cur_fg],
706 1.2.2.2 yamt spx_cmap.g[cur_fg],
707 1.2.2.2 yamt spx_cmap.b[cur_fg]);
708 1.2.2.2 yamt
709 1.2.2.2 yamt /* update cursor position registers */
710 1.2.2.2 yamt set_btreg(SPXDAC_REG_CXLO,
711 1.2.2.2 yamt LO(col * spx_font.fontwidth + CUR_XBIAS));
712 1.2.2.2 yamt set_btreg(SPXDAC_REG_CXHI,
713 1.2.2.2 yamt HI(col * spx_font.fontwidth + CUR_XBIAS));
714 1.2.2.2 yamt set_btreg(SPXDAC_REG_CYLO,
715 1.2.2.2 yamt LO(row * spx_font.fontheight + CUR_YBIAS));
716 1.2.2.2 yamt set_btreg(SPXDAC_REG_CYHI,
717 1.2.2.2 yamt HI(row * spx_font.fontheight + CUR_YBIAS));
718 1.2.2.2 yamt
719 1.2.2.2 yamt if ((cur_on = on))
720 1.2.2.2 yamt /* enable cursor */
721 1.2.2.2 yamt set_btreg(SPXDAC_REG_CCR, 0xc1);
722 1.2.2.2 yamt else
723 1.2.2.2 yamt /* disable cursor */
724 1.2.2.2 yamt set_btreg(SPXDAC_REG_CCR, 0x01);
725 1.2.2.2 yamt #endif
726 1.2.2.2 yamt }
727 1.2.2.2 yamt
728 1.2.2.2 yamt ss->ss_curx = col;
729 1.2.2.2 yamt ss->ss_cury = row;
730 1.2.2.2 yamt ss->ss_cur_bg = cur_bg;
731 1.2.2.2 yamt ss->ss_cur_fg = cur_fg;
732 1.2.2.2 yamt }
733 1.2.2.2 yamt
734 1.2.2.2 yamt static int
735 1.2.2.2 yamt spx_mapchar(void *id, int uni, unsigned int *index)
736 1.2.2.2 yamt {
737 1.2.2.2 yamt if (uni < 256) {
738 1.2.2.2 yamt *index = uni;
739 1.2.2.2 yamt return (5);
740 1.2.2.2 yamt }
741 1.2.2.2 yamt *index = ' ';
742 1.2.2.2 yamt return (0);
743 1.2.2.2 yamt }
744 1.2.2.2 yamt
745 1.2.2.2 yamt static void
746 1.2.2.2 yamt SPX_putchar(int row, int col, u_int c, char dot_fg, char dot_bg)
747 1.2.2.2 yamt {
748 1.2.2.2 yamt u_int counter = 0xffffe;
749 1.2.2.2 yamt long temp = 0;
750 1.2.2.2 yamt
751 1.2.2.2 yamt SPX_REG(SPX_FG) = COLOR(dot_fg);
752 1.2.2.2 yamt SPX_REG(SPX_BG) = COLOR(dot_bg);
753 1.2.2.2 yamt SPX_REG(SPX_MAIN3) = 0x01010101;
754 1.2.2.2 yamt SPX_REG(SPX_COMMAND) = 0x84884648;
755 1.2.2.2 yamt SPX_REG(SPX_XSTART) = (col * spx_font.fontwidth) << 16;
756 1.2.2.2 yamt SPX_REG(SPX_YSTART) = (row * spx_font.fontheight) << 16;
757 1.2.2.2 yamt SPX_REG(SPX_XEND) = ((col + 1) * spx_font.fontwidth) << 16;
758 1.2.2.2 yamt SPX_REG(SPX_YEND) = ((row + 1) * spx_font.fontheight) << 16;
759 1.2.2.2 yamt
760 1.2.2.2 yamt temp = ((SPX_REG1(0x10) & 0xc0) << (30 - 6)) | \
761 1.2.2.2 yamt ((SPX_REG1(0x10) & 0x3f) << 24);
762 1.2.2.2 yamt
763 1.2.2.2 yamt SPX_REG(SPX_DSTPIX) = temp + LINEAR(col * spx_font.fontwidth,
764 1.2.2.2 yamt row * spx_font.fontheight);
765 1.2.2.2 yamt SPX_REG(SPX_SRCPIX) = temp + FONT_STORAGE_START
766 1.2.2.2 yamt + (c * spx_font.fontheight * spx_font.fontwidth);
767 1.2.2.2 yamt SPX_REG(SPX_SRCPIX1) = 0;
768 1.2.2.2 yamt SPX_REG(SPX_STRIDE) = (spx_font.fontwidth << 16) | spx_xsize;
769 1.2.2.2 yamt SPX_REG(SPX_SRCMASK) = 0xff;
770 1.2.2.2 yamt SPX_REG(SPX_DSTMASK) = 0xff;
771 1.2.2.2 yamt
772 1.2.2.2 yamt SPX_REG(SPX_DESTLOOP) = 0x20142003;
773 1.2.2.2 yamt SPX_REG(SPX_MPC) = 0x2000 | SPX_OP_COPYRECT;
774 1.2.2.2 yamt
775 1.2.2.2 yamt SPX_REG1(0x18) = 0xffffffff;
776 1.2.2.2 yamt
777 1.2.2.2 yamt while ((counter) && ((SPX_REG1(0x18) & 2) == 0))
778 1.2.2.2 yamt counter--;
779 1.2.2.2 yamt }
780 1.2.2.2 yamt
781 1.2.2.2 yamt static void
782 1.2.2.2 yamt SPXg_putchar(int row, int col, u_int c, char dot_fg, char dot_bg)
783 1.2.2.2 yamt {
784 1.2.2.2 yamt u_int counter = 0xffffe;
785 1.2.2.2 yamt long temp = 0;
786 1.2.2.2 yamt
787 1.2.2.2 yamt SPXg_REG(SPX_FG) = COLOR(dot_fg);
788 1.2.2.2 yamt spxg_delay();
789 1.2.2.2 yamt SPXg_REG(SPX_BG) = COLOR(dot_bg);
790 1.2.2.2 yamt spxg_delay();
791 1.2.2.2 yamt SPXg_REG(SPX_MAIN3) = 0x01010101;
792 1.2.2.2 yamt spxg_delay();
793 1.2.2.2 yamt SPXg_REG(SPX_COMMAND) = 0x84884648;
794 1.2.2.2 yamt spxg_delay();
795 1.2.2.2 yamt SPXg_REG(SPX_XSTART) = (col * spx_font.fontwidth) << 16;
796 1.2.2.2 yamt spxg_delay();
797 1.2.2.2 yamt SPXg_REG(SPX_YSTART) = (row * spx_font.fontheight) << 16;
798 1.2.2.2 yamt spxg_delay();
799 1.2.2.2 yamt SPXg_REG(SPX_XEND) = ((col + 1) * spx_font.fontwidth) << 16;
800 1.2.2.2 yamt spxg_delay();
801 1.2.2.2 yamt SPXg_REG(SPX_YEND) = ((row + 1) * spx_font.fontheight) << 16;
802 1.2.2.2 yamt spxg_delay();
803 1.2.2.2 yamt
804 1.2.2.2 yamt temp = 0x3f << 24;
805 1.2.2.2 yamt
806 1.2.2.2 yamt SPXg_REG(SPX_DSTPIX) = temp + LINEAR(col * spx_font.fontwidth,
807 1.2.2.2 yamt row * spx_font.fontheight);
808 1.2.2.2 yamt spxg_delay();
809 1.2.2.2 yamt SPXg_REG(SPX_DSTPIX1) = 0xff000000;
810 1.2.2.2 yamt spxg_delay();
811 1.2.2.2 yamt SPXg_REG(SPX_SRCPIX) = temp + FONT_STORAGE_START +
812 1.2.2.2 yamt (c * spx_font.fontheight * spx_font.fontwidth);
813 1.2.2.2 yamt spxg_delay();
814 1.2.2.2 yamt SPXg_REG(SPX_SRCPIX1) = 0;
815 1.2.2.2 yamt spxg_delay();
816 1.2.2.2 yamt SPXg_REG(SPX_STRIDE) = (spx_font.fontwidth << 16) | spx_xsize;
817 1.2.2.2 yamt spxg_delay();
818 1.2.2.2 yamt SPXg_REG(SPX_SRCMASK) = 0xffffffff;
819 1.2.2.2 yamt spxg_delay();
820 1.2.2.2 yamt SPXg_REG(SPX_DSTMASK) = 0xffffffff;
821 1.2.2.2 yamt spxg_delay();
822 1.2.2.2 yamt
823 1.2.2.2 yamt SPXg_REG(SPX_DESTLOOP) = 0x20142003;
824 1.2.2.2 yamt spxg_delay();
825 1.2.2.2 yamt SPXg_REG(SPX_MPC) = 0x2000 | SPX_OP_COPYRECT;
826 1.2.2.2 yamt spxg_delay();
827 1.2.2.2 yamt
828 1.2.2.2 yamt while ((counter) && ((SPXg_REG1(0x0) & 0x8000) == 0))
829 1.2.2.2 yamt counter--;
830 1.2.2.2 yamt }
831 1.2.2.2 yamt
832 1.2.2.2 yamt static void
833 1.2.2.2 yamt spx_putchar(void *id, int row, int col, u_int c, long attr)
834 1.2.2.2 yamt {
835 1.2.2.2 yamt struct spx_screen *ss = id;
836 1.2.2.2 yamt char dot_fg, dot_bg;
837 1.2.2.2 yamt
838 1.2.2.2 yamt c &= 0xff;
839 1.2.2.2 yamt
840 1.2.2.2 yamt ss->ss_image[row * spx_cols + col].data = c;
841 1.2.2.2 yamt ss->ss_image[row * spx_cols + col].attr = attr;
842 1.2.2.2 yamt if (ss != curscr)
843 1.2.2.2 yamt return;
844 1.2.2.2 yamt
845 1.2.2.2 yamt dot_fg = attr & SPX_FG_MASK;
846 1.2.2.2 yamt dot_bg = (attr & SPX_BG_MASK) >> 4;
847 1.2.2.2 yamt if (attr & SPX_ATTR_REVERSE) {
848 1.2.2.2 yamt dot_fg = (attr & SPX_BG_MASK) >> 4;
849 1.2.2.2 yamt dot_bg = attr & SPX_FG_MASK;
850 1.2.2.2 yamt }
851 1.2.2.2 yamt
852 1.2.2.2 yamt /* adjust glyph index for underlined text */
853 1.2.2.2 yamt if (attr & SPX_ATTR_UNDERLINE)
854 1.2.2.2 yamt c += 0x100;
855 1.2.2.2 yamt
856 1.2.2.2 yamt spx_putchar_func(row, col, c, dot_fg, dot_bg);
857 1.2.2.2 yamt }
858 1.2.2.2 yamt
859 1.2.2.2 yamt /*
860 1.2.2.2 yamt * copies columns inside a row.
861 1.2.2.2 yamt */
862 1.2.2.2 yamt static void
863 1.2.2.2 yamt spx_copycols(void *id, int row, int srccol, int dstcol, int ncols)
864 1.2.2.2 yamt {
865 1.2.2.2 yamt struct spx_screen *ss = id;
866 1.2.2.2 yamt
867 1.2.2.2 yamt bcopy(&ss->ss_image[row * spx_cols + srccol],
868 1.2.2.2 yamt &ss->ss_image[row * spx_cols + dstcol],
869 1.2.2.2 yamt ncols * sizeof(ss->ss_image[0]));
870 1.2.2.2 yamt
871 1.2.2.2 yamt if (ss == curscr)
872 1.2.2.2 yamt spx_blkcpy(srccol * spx_font.fontwidth,
873 1.2.2.2 yamt row * spx_font.fontheight,
874 1.2.2.2 yamt dstcol * spx_font.fontwidth,
875 1.2.2.2 yamt row * spx_font.fontheight,
876 1.2.2.2 yamt ncols * spx_font.fontwidth,
877 1.2.2.2 yamt spx_font.fontheight);
878 1.2.2.2 yamt }
879 1.2.2.2 yamt
880 1.2.2.2 yamt /*
881 1.2.2.2 yamt * Erases a bunch of chars inside one row.
882 1.2.2.2 yamt */
883 1.2.2.2 yamt static void
884 1.2.2.2 yamt spx_erasecols(void *id, int row, int startcol, int ncols, long fillattr)
885 1.2.2.2 yamt {
886 1.2.2.2 yamt struct spx_screen *ss = id;
887 1.2.2.2 yamt int offset = row * spx_cols + startcol;
888 1.2.2.2 yamt int i;
889 1.2.2.2 yamt
890 1.2.2.2 yamt memset(&ss->ss_image[row * spx_cols + startcol], 0,
891 1.2.2.2 yamt ncols * sizeof(ss->ss_image[0]));
892 1.2.2.2 yamt
893 1.2.2.2 yamt for (i = offset; i < offset + ncols; ++i)
894 1.2.2.2 yamt ss->ss_image[i].attr = fillattr;
895 1.2.2.2 yamt
896 1.2.2.2 yamt if (ss == curscr)
897 1.2.2.2 yamt spx_blkset(startcol * spx_font.fontwidth,
898 1.2.2.2 yamt row * spx_font.fontheight,
899 1.2.2.2 yamt ncols * spx_font.fontwidth,
900 1.2.2.2 yamt spx_font.fontheight,
901 1.2.2.2 yamt (fillattr & SPX_BG_MASK) >> 4);
902 1.2.2.2 yamt }
903 1.2.2.2 yamt
904 1.2.2.2 yamt static void
905 1.2.2.2 yamt spx_copyrows(void *id, int srcrow, int dstrow, int nrows)
906 1.2.2.2 yamt {
907 1.2.2.2 yamt struct spx_screen *ss = id;
908 1.2.2.2 yamt
909 1.2.2.2 yamt bcopy(&ss->ss_image[srcrow * spx_cols],
910 1.2.2.2 yamt &ss->ss_image[dstrow * spx_cols],
911 1.2.2.2 yamt nrows * spx_cols * sizeof(ss->ss_image[0]));
912 1.2.2.2 yamt
913 1.2.2.2 yamt if (ss == curscr)
914 1.2.2.2 yamt spx_blkcpy(0, (srcrow * spx_font.fontheight),
915 1.2.2.2 yamt 0, (dstrow * spx_font.fontheight),
916 1.2.2.2 yamt spx_xsize, (nrows * spx_font.fontheight));
917 1.2.2.2 yamt }
918 1.2.2.2 yamt
919 1.2.2.2 yamt static void
920 1.2.2.2 yamt spx_eraserows(void *id, int startrow, int nrows, long fillattr)
921 1.2.2.2 yamt {
922 1.2.2.2 yamt struct spx_screen *ss = id;
923 1.2.2.2 yamt int i;
924 1.2.2.2 yamt
925 1.2.2.2 yamt memset(&ss->ss_image[startrow * spx_cols], 0,
926 1.2.2.2 yamt nrows * spx_cols * sizeof(ss->ss_image[0]));
927 1.2.2.2 yamt
928 1.2.2.2 yamt for (i = startrow * spx_cols; i < startrow + nrows * spx_cols; ++i)
929 1.2.2.2 yamt ss->ss_image[i].attr = fillattr;
930 1.2.2.2 yamt
931 1.2.2.2 yamt if (ss == curscr)
932 1.2.2.2 yamt spx_blkset(0, (startrow * spx_font.fontheight),
933 1.2.2.2 yamt spx_xsize, (nrows * spx_font.fontheight),
934 1.2.2.2 yamt (fillattr & SPX_BG_MASK) >> 4);
935 1.2.2.2 yamt }
936 1.2.2.2 yamt
937 1.2.2.2 yamt static int
938 1.2.2.2 yamt spx_allocattr(void *id, int fg, int bg, int flags, long *attrp)
939 1.2.2.2 yamt {
940 1.2.2.2 yamt long myattr;
941 1.2.2.2 yamt
942 1.2.2.2 yamt if (flags & WSATTR_WSCOLORS)
943 1.2.2.2 yamt myattr = (fg & SPX_FG_MASK) | ((bg << 4) & SPX_BG_MASK);
944 1.2.2.2 yamt else
945 1.2.2.2 yamt myattr = WSCOL_WHITE << 4; /* XXXX */
946 1.2.2.2 yamt if (flags & WSATTR_REVERSE)
947 1.2.2.2 yamt myattr |= SPX_ATTR_REVERSE;
948 1.2.2.2 yamt if (flags & WSATTR_UNDERLINE)
949 1.2.2.2 yamt myattr |= SPX_ATTR_UNDERLINE;
950 1.2.2.2 yamt *attrp = myattr;
951 1.2.2.2 yamt return 0;
952 1.2.2.2 yamt }
953 1.2.2.2 yamt
954 1.2.2.2 yamt static int
955 1.2.2.2 yamt spx_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l)
956 1.2.2.2 yamt {
957 1.2.2.2 yamt struct wsdisplay_fbinfo *fb = data;
958 1.2.2.2 yamt int i;
959 1.2.2.2 yamt
960 1.2.2.2 yamt switch (cmd) {
961 1.2.2.2 yamt case WSDISPLAYIO_GTYPE:
962 1.2.2.2 yamt *(u_int *)data = WSDISPLAY_TYPE_SPX;
963 1.2.2.2 yamt break;
964 1.2.2.2 yamt
965 1.2.2.2 yamt case WSDISPLAYIO_GINFO:
966 1.2.2.2 yamt fb->height = spx_ysize;
967 1.2.2.2 yamt fb->width = spx_xsize;
968 1.2.2.2 yamt fb->depth = spx_depth;
969 1.2.2.2 yamt fb->cmsize = 1 << spx_depth;
970 1.2.2.2 yamt break;
971 1.2.2.2 yamt
972 1.2.2.2 yamt case WSDISPLAYIO_GETCMAP:
973 1.2.2.2 yamt return spx_get_cmap((struct wsdisplay_cmap *)data);
974 1.2.2.2 yamt
975 1.2.2.2 yamt case WSDISPLAYIO_PUTCMAP:
976 1.2.2.2 yamt return spx_set_cmap((struct wsdisplay_cmap *)data);
977 1.2.2.2 yamt
978 1.2.2.2 yamt case WSDISPLAYIO_GMODE:
979 1.2.2.2 yamt return EPASSTHROUGH;
980 1.2.2.2 yamt
981 1.2.2.2 yamt case WSDISPLAYIO_SMODE:
982 1.2.2.2 yamt /*
983 1.2.2.2 yamt * if setting WSDISPLAYIO_MODE_EMUL, restore console cmap,
984 1.2.2.2 yamt * current screen
985 1.2.2.2 yamt */
986 1.2.2.2 yamt if (*(u_int *)data == WSDISPLAYIO_MODE_EMUL) {
987 1.2.2.2 yamt for (i = 0; i < 8; i++) {
988 1.2.2.2 yamt spx_cmap.r[i] = spx_default_cmap.r[i];
989 1.2.2.2 yamt spx_cmap.g[i] = spx_default_cmap.g[i];
990 1.2.2.2 yamt spx_cmap.b[i] = spx_default_cmap.b[i];
991 1.2.2.2 yamt spx_update_cmap(i, spx_cmap.r[i], spx_cmap.g[i],
992 1.2.2.2 yamt spx_cmap.b[i]);
993 1.2.2.2 yamt }
994 1.2.2.2 yamt if (savescr != NULL)
995 1.2.2.2 yamt spx_show_screen(NULL, savescr, 0, NULL, NULL);
996 1.2.2.2 yamt savescr = NULL;
997 1.2.2.2 yamt } else { /* WSDISPLAYIO_MODE_MAPPED */
998 1.2.2.2 yamt savescr = curscr;
999 1.2.2.2 yamt curscr = NULL;
1000 1.2.2.2 yamt /* clear screen? */
1001 1.2.2.2 yamt }
1002 1.2.2.2 yamt
1003 1.2.2.2 yamt return EPASSTHROUGH;
1004 1.2.2.2 yamt
1005 1.2.2.2 yamt case WSDISPLAYIO_SVIDEO:
1006 1.2.2.2 yamt if (*(u_int *)data == WSDISPLAYIO_VIDEO_ON && spx_off) {
1007 1.2.2.2 yamt /* Unblank video */
1008 1.2.2.2 yamt set_btreg(SPXDAC_REG_CMD0, 0x48);
1009 1.2.2.2 yamt
1010 1.2.2.2 yamt /* Enable sync */
1011 1.2.2.2 yamt set_btreg(SPXDAC_REG_CMD2, 0xc0);
1012 1.2.2.2 yamt
1013 1.2.2.2 yamt spx_off = 0;
1014 1.2.2.2 yamt } else if (*(u_int *)data == WSDISPLAYIO_VIDEO_OFF && !spx_off) {
1015 1.2.2.2 yamt /* Blank video */
1016 1.2.2.2 yamt set_btreg(SPXDAC_REG_CMD0, 68);
1017 1.2.2.2 yamt
1018 1.2.2.2 yamt /* Disable sync */
1019 1.2.2.2 yamt set_btreg(SPXDAC_REG_CMD2, 0x40);
1020 1.2.2.2 yamt spx_off = 1;
1021 1.2.2.2 yamt }
1022 1.2.2.2 yamt break;
1023 1.2.2.2 yamt
1024 1.2.2.2 yamt case WSDISPLAYIO_GVIDEO:
1025 1.2.2.2 yamt *(u_int *)data = spx_off == 0 ?
1026 1.2.2.2 yamt WSDISPLAYIO_VIDEO_ON : WSDISPLAYIO_VIDEO_OFF;
1027 1.2.2.2 yamt break;
1028 1.2.2.2 yamt
1029 1.2.2.2 yamt default:
1030 1.2.2.2 yamt return EPASSTHROUGH;
1031 1.2.2.2 yamt }
1032 1.2.2.2 yamt return 0;
1033 1.2.2.2 yamt }
1034 1.2.2.2 yamt
1035 1.2.2.2 yamt /*
1036 1.2.2.2 yamt * Bad idea on SPXg/gt due to windowed framebuffer access
1037 1.2.2.2 yamt */
1038 1.2.2.2 yamt static paddr_t
1039 1.2.2.2 yamt spx_mmap(void *v, void *vs, off_t offset, int prot)
1040 1.2.2.2 yamt {
1041 1.2.2.2 yamt if (fb_type != FB_IS_SPX)
1042 1.2.2.2 yamt return -1;
1043 1.2.2.2 yamt
1044 1.2.2.2 yamt if (offset >= spx_fb_size || offset < 0)
1045 1.2.2.2 yamt return -1;
1046 1.2.2.2 yamt
1047 1.2.2.2 yamt return (SPX_FB_ADDR + offset) >> PGSHIFT;
1048 1.2.2.2 yamt }
1049 1.2.2.2 yamt
1050 1.2.2.2 yamt static int
1051 1.2.2.2 yamt spx_alloc_screen(void *v, const struct wsscreen_descr *type, void **cookiep,
1052 1.2.2.2 yamt int *curxp, int *curyp, long *defattrp)
1053 1.2.2.2 yamt {
1054 1.2.2.2 yamt int i;
1055 1.2.2.2 yamt struct spx_screen *ss;
1056 1.2.2.2 yamt
1057 1.2.2.2 yamt ss = malloc(sizeof(struct spx_screen), M_DEVBUF, M_WAITOK | M_ZERO);
1058 1.2.2.2 yamt
1059 1.2.2.2 yamt *cookiep = ss;
1060 1.2.2.2 yamt *curxp = *curyp = 0;
1061 1.2.2.2 yamt *defattrp = (SPX_BG_COLOR << 4) | SPX_FG_COLOR;
1062 1.2.2.2 yamt
1063 1.2.2.2 yamt for (i = 0; i < spx_cols * spx_rows; ++i)
1064 1.2.2.2 yamt ss->ss_image[i].attr = *defattrp;
1065 1.2.2.2 yamt
1066 1.2.2.2 yamt return 0;
1067 1.2.2.2 yamt }
1068 1.2.2.2 yamt
1069 1.2.2.2 yamt static void
1070 1.2.2.2 yamt spx_free_screen(void *v, void *cookie)
1071 1.2.2.2 yamt {
1072 1.2.2.3 yamt /* FIXME add something to actually free malloc()ed screen? */
1073 1.2.2.2 yamt }
1074 1.2.2.2 yamt
1075 1.2.2.2 yamt static int
1076 1.2.2.2 yamt spx_show_screen(void *v, void *cookie, int waitok,
1077 1.2.2.2 yamt void (*cb)(void *, int, int), void *cbarg)
1078 1.2.2.2 yamt {
1079 1.2.2.2 yamt struct spx_screen *ss = cookie;
1080 1.2.2.2 yamt u_int row, col, attr;
1081 1.2.2.2 yamt u_char c;
1082 1.2.2.2 yamt
1083 1.2.2.2 yamt if (ss == curscr)
1084 1.2.2.2 yamt return (0);
1085 1.2.2.2 yamt
1086 1.2.2.2 yamt prevscr = curscr;
1087 1.2.2.2 yamt curscr = ss;
1088 1.2.2.2 yamt
1089 1.2.2.2 yamt for (row = 0; row < spx_rows; row++) {
1090 1.2.2.2 yamt for (col = 0; col < spx_cols; col++) {
1091 1.2.2.2 yamt u_int idx = row * spx_cols + col;
1092 1.2.2.2 yamt attr = ss->ss_image[idx].attr;
1093 1.2.2.2 yamt c = ss->ss_image[idx].data;
1094 1.2.2.2 yamt
1095 1.2.2.2 yamt /* check if cell requires updating */
1096 1.2.2.2 yamt if ((c != prevscr->ss_image[idx].data) ||
1097 1.2.2.2 yamt (attr != prevscr->ss_image[idx].attr)) {
1098 1.2.2.2 yamt if (c < 32) c = 32;
1099 1.2.2.2 yamt spx_putchar(ss, row, col, c, attr);
1100 1.2.2.2 yamt }
1101 1.2.2.2 yamt }
1102 1.2.2.2 yamt }
1103 1.2.2.2 yamt
1104 1.2.2.2 yamt row = ss->ss_cury; col = ss->ss_curx;
1105 1.2.2.2 yamt
1106 1.2.2.2 yamt spx_cursor(ss, cur_on, row, col);
1107 1.2.2.2 yamt
1108 1.2.2.2 yamt cur_fg = ss->ss_cur_fg;
1109 1.2.2.2 yamt cur_bg = ss->ss_cur_bg;
1110 1.2.2.2 yamt
1111 1.2.2.2 yamt return (0);
1112 1.2.2.2 yamt }
1113 1.2.2.2 yamt
1114 1.2.2.2 yamt static int
1115 1.2.2.2 yamt spx_get_cmap(struct wsdisplay_cmap *p)
1116 1.2.2.2 yamt {
1117 1.2.2.2 yamt u_int index = p->index, count = p->count;
1118 1.2.2.2 yamt int error;
1119 1.2.2.2 yamt
1120 1.2.2.2 yamt if (index >= (1 << spx_depth) || count > (1 << spx_depth) - index)
1121 1.2.2.2 yamt return (EINVAL);
1122 1.2.2.2 yamt
1123 1.2.2.2 yamt error = copyout(&spx_cmap.r[index], p->red, count);
1124 1.2.2.2 yamt if (error)
1125 1.2.2.2 yamt return error;
1126 1.2.2.2 yamt
1127 1.2.2.2 yamt error = copyout(&spx_cmap.g[index], p->green, count);
1128 1.2.2.2 yamt if (error)
1129 1.2.2.2 yamt return error;
1130 1.2.2.2 yamt
1131 1.2.2.2 yamt error = copyout(&spx_cmap.b[index], p->blue, count);
1132 1.2.2.2 yamt return error;
1133 1.2.2.2 yamt }
1134 1.2.2.2 yamt
1135 1.2.2.2 yamt static int
1136 1.2.2.2 yamt spx_set_cmap(struct wsdisplay_cmap *p)
1137 1.2.2.2 yamt {
1138 1.2.2.2 yamt u_int index = p->index, count = p->count;
1139 1.2.2.2 yamt int error, s;
1140 1.2.2.2 yamt
1141 1.2.2.2 yamt if (index >= (1 << spx_depth) || count > (1 << spx_depth) - index)
1142 1.2.2.2 yamt return (EINVAL);
1143 1.2.2.2 yamt
1144 1.2.2.2 yamt error = copyin(p->red, &spx_cmap.r[index], count);
1145 1.2.2.2 yamt if (error)
1146 1.2.2.2 yamt return error;
1147 1.2.2.2 yamt
1148 1.2.2.2 yamt error = copyin(p->green, &spx_cmap.g[index], count);
1149 1.2.2.2 yamt if (error)
1150 1.2.2.2 yamt return error;
1151 1.2.2.2 yamt
1152 1.2.2.2 yamt error = copyin(p->blue, &spx_cmap.b[index], count);
1153 1.2.2.2 yamt
1154 1.2.2.2 yamt if (error)
1155 1.2.2.2 yamt return error;
1156 1.2.2.2 yamt
1157 1.2.2.2 yamt s = spltty();
1158 1.2.2.2 yamt while (count-- > 0) {
1159 1.2.2.2 yamt spx_update_cmap(index,
1160 1.2.2.2 yamt spx_cmap.r[index],
1161 1.2.2.2 yamt spx_cmap.g[index],
1162 1.2.2.2 yamt spx_cmap.b[index]);
1163 1.2.2.2 yamt index++;
1164 1.2.2.2 yamt }
1165 1.2.2.2 yamt splx(s);
1166 1.2.2.2 yamt return (0);
1167 1.2.2.2 yamt }
1168 1.2.2.2 yamt
1169 1.2.2.2 yamt cons_decl(spx);
1170 1.2.2.2 yamt
1171 1.2.2.2 yamt void
1172 1.2.2.2 yamt spxcninit(struct consdev *cndev)
1173 1.2.2.2 yamt {
1174 1.2.2.2 yamt int i;
1175 1.2.2.2 yamt
1176 1.2.2.2 yamt spx_blkset(0, 0, spx_xsize, spx_ysize, SPX_BG_COLOR);
1177 1.2.2.2 yamt
1178 1.2.2.2 yamt curscr = &spx_conscreen;
1179 1.2.2.3 yamt
1180 1.2.2.2 yamt for (i = 0; i < spx_cols * spx_rows; i++)
1181 1.2.2.2 yamt spx_conscreen.ss_image[i].attr =
1182 1.2.2.2 yamt (SPX_BG_COLOR << 4) | SPX_FG_COLOR;
1183 1.2.2.2 yamt wsdisplay_cnattach(&spx_stdscreen, &spx_conscreen, 0, 0,
1184 1.2.2.2 yamt (SPX_BG_COLOR << 4) | SPX_FG_COLOR);
1185 1.2.2.2 yamt cn_tab->cn_pri = CN_INTERNAL;
1186 1.2.2.2 yamt
1187 1.2.2.2 yamt #if NDZKBD > 0
1188 1.2.2.2 yamt dzkbd_cnattach(0); /* Connect keyboard and screen together */
1189 1.2.2.2 yamt #endif
1190 1.2.2.2 yamt }
1191 1.2.2.2 yamt
1192 1.2.2.2 yamt /*
1193 1.2.2.2 yamt * Called very early to setup the glass tty as console.
1194 1.2.2.2 yamt * Because it's called before the VM system is inited, virtual memory
1195 1.2.2.2 yamt * for the framebuffer can be stolen directly without disturbing anything.
1196 1.2.2.2 yamt */
1197 1.2.2.2 yamt void
1198 1.2.2.2 yamt spxcnprobe(struct consdev *cndev)
1199 1.2.2.2 yamt {
1200 1.2.2.2 yamt extern const struct cdevsw wsdisplay_cdevsw;
1201 1.2.2.2 yamt
1202 1.2.2.2 yamt /* Only for VS 4000/90, 90A and 96 with LCSPX or SPXg/gt*/
1203 1.2.2.2 yamt if ((vax_boardtype != VAX_BTYP_49) ||
1204 1.2.2.3 yamt ((vax_confdata & (CONF_LCSPX | CONF_SPXg)) == 0))
1205 1.2.2.2 yamt return;
1206 1.2.2.2 yamt
1207 1.2.2.2 yamt if (((vax_confdata & 8) && (vax_boardtype == VAX_BTYP_49)) ||
1208 1.2.2.2 yamt (((vax_confdata & KA420_CFG_L3CON) ||
1209 1.2.2.2 yamt (vax_confdata & KA420_CFG_MULTU)) &&
1210 1.2.2.2 yamt ((vax_boardtype == VAX_BTYP_420) ||
1211 1.2.2.2 yamt (vax_boardtype == VAX_BTYP_43)))) {
1212 1.2.2.2 yamt aprint_normal("spxcnprobe: Diagnostic console\n");
1213 1.2.2.2 yamt return; /* Diagnostic console */
1214 1.2.2.2 yamt }
1215 1.2.2.2 yamt
1216 1.2.2.2 yamt spx_init_common(NULL, NULL);
1217 1.2.2.2 yamt
1218 1.2.2.2 yamt cndev->cn_pri = CN_INTERNAL;
1219 1.2.2.2 yamt cndev->cn_dev = makedev(cdevsw_lookup_major(&wsdisplay_cdevsw), 0);
1220 1.2.2.2 yamt }
1221 1.2.2.2 yamt
1222 1.2.2.2 yamt static int
1223 1.2.2.2 yamt spx_map_regs(device_t self,
1224 1.2.2.2 yamt u_int raddr, u_int rsize, u_int r1addr, u_int r1size)
1225 1.2.2.2 yamt {
1226 1.2.2.2 yamt extern vaddr_t virtual_avail;
1227 1.2.2.2 yamt
1228 1.2.2.2 yamt if (!self) {
1229 1.2.2.2 yamt regaddr = (long*)virtual_avail;
1230 1.2.2.2 yamt virtual_avail += rsize;
1231 1.2.2.2 yamt ioaccess((vaddr_t)regaddr, raddr, rsize/VAX_NBPG);
1232 1.2.2.2 yamt
1233 1.2.2.2 yamt regaddr1 = (long*)virtual_avail;
1234 1.2.2.2 yamt virtual_avail += r1size;
1235 1.2.2.2 yamt ioaccess((vaddr_t)regaddr1, r1addr, r1size/VAX_NBPG);
1236 1.2.2.2 yamt
1237 1.2.2.2 yamt return 1;
1238 1.2.2.2 yamt }
1239 1.2.2.2 yamt
1240 1.2.2.2 yamt regaddr = (long*)vax_map_physmem(raddr, rsize/VAX_NBPG);
1241 1.2.2.2 yamt if (regaddr == 0) {
1242 1.2.2.2 yamt aprint_error_dev(self,
1243 1.2.2.2 yamt "unable to allocate register memory (1).\n");
1244 1.2.2.2 yamt return 0;
1245 1.2.2.2 yamt }
1246 1.2.2.2 yamt
1247 1.2.2.2 yamt regaddr1 = (long*)vax_map_physmem(r1addr, r1size/VAX_NBPG);
1248 1.2.2.2 yamt if (regaddr1 == 0) {
1249 1.2.2.2 yamt aprint_error_dev(self,
1250 1.2.2.2 yamt "unable to allocate register memory (2).\n");
1251 1.2.2.2 yamt return 0;
1252 1.2.2.2 yamt }
1253 1.2.2.2 yamt
1254 1.2.2.2 yamt return 1;
1255 1.2.2.2 yamt }
1256 1.2.2.2 yamt
1257 1.2.2.2 yamt static int
1258 1.2.2.2 yamt SPX_map_fb(device_t self, struct vsbus_attach_args *va)
1259 1.2.2.2 yamt {
1260 1.2.2.2 yamt int fbsize = (spx_fb_size + FONT_STORAGE_SIZE)/VAX_NBPG;
1261 1.2.2.2 yamt extern vaddr_t virtual_avail;
1262 1.2.2.2 yamt
1263 1.2.2.2 yamt if (!self) {
1264 1.2.2.2 yamt spxaddr = (char *)virtual_avail;
1265 1.2.2.2 yamt virtual_avail += (spx_fb_size + FONT_STORAGE_SIZE);
1266 1.2.2.2 yamt ioaccess((vaddr_t)spxaddr, SPX_FB_ADDR, fbsize);
1267 1.2.2.2 yamt
1268 1.2.2.2 yamt bt_addrl = (char *)virtual_avail;
1269 1.2.2.2 yamt virtual_avail += VAX_NBPG;
1270 1.2.2.2 yamt ioaccess((vaddr_t)bt_addrl, SPX_BT459_ADDRL, 1);
1271 1.2.2.2 yamt
1272 1.2.2.2 yamt bt_addrh = (char *)virtual_avail;
1273 1.2.2.2 yamt virtual_avail += VAX_NBPG;
1274 1.2.2.2 yamt ioaccess((vaddr_t)bt_addrh, SPX_BT459_ADDRH, 1);
1275 1.2.2.2 yamt
1276 1.2.2.2 yamt bt_reg = (char *)virtual_avail;
1277 1.2.2.2 yamt virtual_avail += VAX_NBPG;
1278 1.2.2.2 yamt ioaccess((vaddr_t)bt_reg, SPX_BT459_REG, 1);
1279 1.2.2.2 yamt
1280 1.2.2.2 yamt bt_cmap = (char *)virtual_avail;
1281 1.2.2.2 yamt virtual_avail += VAX_NBPG;
1282 1.2.2.2 yamt ioaccess((vaddr_t)bt_cmap, SPX_BT459_CMAP, 1);
1283 1.2.2.2 yamt
1284 1.2.2.2 yamt return 1;
1285 1.2.2.2 yamt }
1286 1.2.2.2 yamt
1287 1.2.2.2 yamt spxaddr = (char *)vax_map_physmem(va->va_paddr, fbsize);
1288 1.2.2.2 yamt if (spxaddr == 0) {
1289 1.2.2.2 yamt aprint_error_dev(self, "unable to map framebuffer memory.\n");
1290 1.2.2.2 yamt return 0;
1291 1.2.2.2 yamt }
1292 1.2.2.2 yamt
1293 1.2.2.2 yamt /* map all four RAMDAC registers */
1294 1.2.2.2 yamt bt_addrl = (char *)vax_map_physmem(SPX_BT459_ADDRL, 1);
1295 1.2.2.2 yamt if (bt_addrl == 0) {
1296 1.2.2.2 yamt aprint_error_dev(self,
1297 1.2.2.2 yamt "unable to map BT459 Low Address register.\n");
1298 1.2.2.2 yamt return 0;
1299 1.2.2.2 yamt }
1300 1.2.2.2 yamt
1301 1.2.2.2 yamt bt_addrh = (char *)vax_map_physmem(SPX_BT459_ADDRH, 1);
1302 1.2.2.2 yamt if (bt_addrh == 0) {
1303 1.2.2.2 yamt aprint_error_dev(self,
1304 1.2.2.2 yamt "unable to map BT459 High Address register.\n");
1305 1.2.2.2 yamt return 0;
1306 1.2.2.2 yamt }
1307 1.2.2.2 yamt
1308 1.2.2.2 yamt bt_reg = (char *)vax_map_physmem(SPX_BT459_REG, 1);
1309 1.2.2.2 yamt if (bt_reg == 0) {
1310 1.2.2.2 yamt aprint_error_dev(self,
1311 1.2.2.2 yamt "unable to map BT459 I/O Register.\n");
1312 1.2.2.2 yamt return 0;
1313 1.2.2.2 yamt }
1314 1.2.2.2 yamt
1315 1.2.2.2 yamt bt_cmap = (char *)vax_map_physmem(SPX_BT459_CMAP, 1);
1316 1.2.2.2 yamt if (bt_cmap == 0) {
1317 1.2.2.2 yamt aprint_error_dev(self,
1318 1.2.2.2 yamt "unable to map BT459 Color Map register.\n");
1319 1.2.2.2 yamt return 0;
1320 1.2.2.2 yamt }
1321 1.2.2.2 yamt
1322 1.2.2.2 yamt return 1;
1323 1.2.2.2 yamt }
1324 1.2.2.2 yamt
1325 1.2.2.2 yamt static int
1326 1.2.2.2 yamt SPXg_map_fb(device_t self, struct vsbus_attach_args *va)
1327 1.2.2.2 yamt {
1328 1.2.2.2 yamt int fbsize = SPXg_WIN_SIZE/VAX_NBPG;
1329 1.2.2.2 yamt extern vaddr_t virtual_avail;
1330 1.2.2.2 yamt
1331 1.2.2.2 yamt if (!self) {
1332 1.2.2.2 yamt spxaddr = (char *)virtual_avail;
1333 1.2.2.2 yamt virtual_avail += SPXg_WIN_SIZE;
1334 1.2.2.2 yamt ioaccess((vaddr_t)spxaddr, SPXg_FB_ADDR, fbsize);
1335 1.2.2.2 yamt
1336 1.2.2.2 yamt bt_addrl = (char *)virtual_avail;
1337 1.2.2.2 yamt virtual_avail += VAX_NBPG;
1338 1.2.2.2 yamt ioaccess((vaddr_t)bt_addrl, SPXg_BT460_BASE, 1);
1339 1.2.2.2 yamt
1340 1.2.2.2 yamt bt_addrh = bt_addrl + 0x04;
1341 1.2.2.2 yamt bt_reg = bt_addrl + 0x08;
1342 1.2.2.2 yamt bt_cmap = bt_addrl + 0x0c;
1343 1.2.2.2 yamt bt_wait = bt_addrl + 0x34;
1344 1.2.2.2 yamt
1345 1.2.2.2 yamt return 1;
1346 1.2.2.2 yamt }
1347 1.2.2.2 yamt
1348 1.2.2.2 yamt spxaddr = (char *)vax_map_physmem(va->va_paddr, fbsize);
1349 1.2.2.2 yamt if (spxaddr == 0) {
1350 1.2.2.2 yamt aprint_error_dev(self,
1351 1.2.2.2 yamt "unable to map framebuffer memory window.\n");
1352 1.2.2.2 yamt return 0;
1353 1.2.2.2 yamt }
1354 1.2.2.2 yamt
1355 1.2.2.2 yamt bt_addrl = (char *)vax_map_physmem(SPXg_BT460_BASE, 1);
1356 1.2.2.2 yamt if (bt_addrl == 0) {
1357 1.2.2.2 yamt aprint_error_dev(self,
1358 1.2.2.2 yamt "unable to map BT460 Low Address register.\n");
1359 1.2.2.2 yamt return 0;
1360 1.2.2.2 yamt }
1361 1.2.2.2 yamt bt_addrh = bt_addrl + 0x04;
1362 1.2.2.2 yamt bt_reg = bt_addrl + 0x08;
1363 1.2.2.2 yamt bt_cmap = bt_addrl + 0x0c;
1364 1.2.2.2 yamt bt_wait = bt_addrl + 0x34;
1365 1.2.2.2 yamt
1366 1.2.2.2 yamt return 1;
1367 1.2.2.2 yamt }
1368 1.2.2.2 yamt
1369 1.2.2.2 yamt static void
1370 1.2.2.2 yamt SPX_render_font(void)
1371 1.2.2.2 yamt {
1372 1.2.2.2 yamt volatile char *fontaddr = spxaddr + FONT_STORAGE_START;
1373 1.2.2.2 yamt int i, j, k, ch, pixel;
1374 1.2.2.2 yamt
1375 1.2.2.2 yamt for (i = 0; i < 256; i++) for (j = 0; j < spx_font.fontheight; j++) {
1376 1.2.2.2 yamt ch = QFONT(i, j);
1377 1.2.2.2 yamt
1378 1.2.2.2 yamt /* regular characters */
1379 1.2.2.2 yamt pixel = ((i * spx_font.fontheight)+ j) * spx_font.fontwidth;
1380 1.2.2.2 yamt for (k = 0; k < spx_font.fontwidth; k++)
1381 1.2.2.2 yamt if (ch & (1 << k))
1382 1.2.2.2 yamt fontaddr[pixel++] = 0xff;
1383 1.2.2.2 yamt else
1384 1.2.2.2 yamt fontaddr[pixel++] = 0x00;
1385 1.2.2.2 yamt
1386 1.2.2.2 yamt /* underlined characters */
1387 1.2.2.2 yamt pixel = (((i + 256) * spx_font.fontheight) + j)
1388 1.2.2.2 yamt * spx_font.fontwidth;
1389 1.2.2.2 yamt for (k = 0; k < spx_font.fontwidth; k++)
1390 1.2.2.2 yamt if ((ch & (1 << k)) || (j == (spx_font.fontheight - 1)))
1391 1.2.2.2 yamt fontaddr[pixel++] = 0xff;
1392 1.2.2.2 yamt else
1393 1.2.2.2 yamt fontaddr[pixel++] = 0x00;
1394 1.2.2.2 yamt }
1395 1.2.2.2 yamt }
1396 1.2.2.2 yamt
1397 1.2.2.2 yamt static void
1398 1.2.2.2 yamt SPXg_render_font(void)
1399 1.2.2.2 yamt {
1400 1.2.2.2 yamt int i, j, k, ch, pixel;
1401 1.2.2.2 yamt
1402 1.2.2.2 yamt for (i = 0; i < 256; i++) for (j = 0; j < spx_font.fontheight; j++) {
1403 1.2.2.2 yamt ch = QFONT(i, j);
1404 1.2.2.2 yamt /* regular characters */
1405 1.2.2.2 yamt for (k = 0; k < spx_font.fontwidth; k++) {
1406 1.2.2.2 yamt pixel = FONT_STORAGE_START
1407 1.2.2.2 yamt + (((i * spx_font.fontheight) + j)
1408 1.2.2.2 yamt * spx_font.fontwidth) + k;
1409 1.2.2.2 yamt if ((pixel / SPXg_WIN_LINEAR) != spxg_current_page) {
1410 1.2.2.2 yamt spxg_switch_page(pixel / SPXg_WIN_LINEAR);
1411 1.2.2.2 yamt spxg_current_page = (pixel / SPXg_WIN_LINEAR);
1412 1.2.2.2 yamt }
1413 1.2.2.2 yamt SPXg_ADDR(pixel) = ch & (1 << k) ? 0xff : 0x00;
1414 1.2.2.2 yamt spxg_delay();
1415 1.2.2.2 yamt }
1416 1.2.2.2 yamt
1417 1.2.2.2 yamt /* underlined characters */
1418 1.2.2.2 yamt for (k = 0; k < spx_font.fontwidth; k++) {
1419 1.2.2.2 yamt pixel = FONT_STORAGE_START
1420 1.2.2.2 yamt + ((((i + 256) * spx_font.fontheight) + j)
1421 1.2.2.2 yamt * spx_font.fontwidth) + k;
1422 1.2.2.2 yamt if ((pixel / SPXg_WIN_LINEAR) != spxg_current_page) {
1423 1.2.2.2 yamt spxg_switch_page(pixel / SPXg_WIN_LINEAR);
1424 1.2.2.2 yamt spxg_current_page = (pixel / SPXg_WIN_LINEAR);
1425 1.2.2.2 yamt }
1426 1.2.2.2 yamt if ((ch & (1 << k)) || (j == (spx_font.fontheight - 1)))
1427 1.2.2.2 yamt SPXg_ADDR(pixel) = 0xff;
1428 1.2.2.2 yamt else
1429 1.2.2.2 yamt SPXg_ADDR(pixel) = 0x00;
1430 1.2.2.2 yamt spxg_delay();
1431 1.2.2.2 yamt }
1432 1.2.2.2 yamt }
1433 1.2.2.2 yamt }
1434 1.2.2.2 yamt
1435 1.2.2.2 yamt static void
1436 1.2.2.2 yamt spx_init_common(device_t self, struct vsbus_attach_args *va)
1437 1.2.2.2 yamt {
1438 1.2.2.2 yamt u_int i, j, k;
1439 1.2.2.2 yamt int cookie;
1440 1.2.2.2 yamt struct wsdisplay_font *wf;
1441 1.2.2.3 yamt static int init_done;
1442 1.2.2.3 yamt
1443 1.2.2.3 yamt if (init_done)
1444 1.2.2.3 yamt return;
1445 1.2.2.3 yamt
1446 1.2.2.3 yamt /* KA49: Identify framebuffer type */
1447 1.2.2.3 yamt switch (vax_confdata & (CONF_LCSPX | CONF_SPXg)) {
1448 1.2.2.3 yamt case CONF_LCSPX:
1449 1.2.2.3 yamt fb_type = FB_IS_SPX;
1450 1.2.2.3 yamt spx_blkcpy_func = SPX_blkcpy;
1451 1.2.2.3 yamt spx_blkset_func = SPX_blkset;
1452 1.2.2.3 yamt spx_putchar_func = SPX_putchar;
1453 1.2.2.3 yamt break;
1454 1.2.2.3 yamt case CONF_SPXg:
1455 1.2.2.3 yamt fb_type = FB_IS_SPXg;
1456 1.2.2.3 yamt spx_blkcpy_func = SPXg_blkcpy;
1457 1.2.2.3 yamt spx_blkset_func = SPXg_blkset;
1458 1.2.2.3 yamt spx_putchar_func = SPXg_putchar;
1459 1.2.2.3 yamt break;
1460 1.2.2.3 yamt case CONF_LCSPX | CONF_SPXg:
1461 1.2.2.3 yamt panic("spxcnprobe: incorrect FB configuration\n");
1462 1.2.2.3 yamt break;
1463 1.2.2.3 yamt }
1464 1.2.2.2 yamt
1465 1.2.2.2 yamt /* map SPX registers first */
1466 1.2.2.2 yamt if (fb_type == FB_IS_SPX) {
1467 1.2.2.2 yamt SPX_MAP_REGS(self, SPX);
1468 1.2.2.2 yamt } else if(fb_type == FB_IS_SPXg) {
1469 1.2.2.2 yamt SPX_MAP_REGS(self, SPXg);
1470 1.2.2.2 yamt }
1471 1.2.2.2 yamt
1472 1.2.2.2 yamt if (fb_type == FB_IS_SPXg)
1473 1.2.2.2 yamt spxg_switch_page(0);
1474 1.2.2.2 yamt
1475 1.2.2.2 yamt /* any KA42/43 SPX resolution detection code should be placed here */
1476 1.2.2.2 yamt spx_depth = 8;
1477 1.2.2.2 yamt spx_xsize = 1280;
1478 1.2.2.2 yamt spx_ysize = 1024;
1479 1.2.2.2 yamt
1480 1.2.2.2 yamt wsfont_init();
1481 1.2.2.2 yamt
1482 1.2.2.2 yamt cookie = wsfont_find(NULL, 12, 21, 0, WSDISPLAY_FONTORDER_R2L,
1483 1.2.2.2 yamt WSDISPLAY_FONTORDER_L2R);
1484 1.2.2.2 yamt if (cookie == -1)
1485 1.2.2.2 yamt cookie = wsfont_find(NULL, 16, 0, 0, WSDISPLAY_FONTORDER_R2L, 0);
1486 1.2.2.2 yamt if (cookie == -1)
1487 1.2.2.2 yamt cookie = wsfont_find(NULL, 12, 0, 0, WSDISPLAY_FONTORDER_R2L, 0);
1488 1.2.2.2 yamt if (cookie == -1)
1489 1.2.2.2 yamt cookie = wsfont_find(NULL, 8, 0, 0, WSDISPLAY_FONTORDER_R2L, 0);
1490 1.2.2.2 yamt if (cookie == -1)
1491 1.2.2.2 yamt cookie = wsfont_find(NULL, 0, 0, 0, WSDISPLAY_FONTORDER_R2L,
1492 1.2.2.2 yamt WSDISPLAY_FONTORDER_L2R);
1493 1.2.2.2 yamt
1494 1.2.2.2 yamt if (cookie == -1 || wsfont_lock(cookie, &wf))
1495 1.2.2.2 yamt panic("spx_common_init: unable to load console font");
1496 1.2.2.2 yamt
1497 1.2.2.2 yamt spx_font = *wf;
1498 1.2.2.2 yamt
1499 1.2.2.2 yamt if (self != NULL) {
1500 1.2.2.2 yamt aprint_normal_dev(self, "Using %s %dx%d font\n", wf->name,
1501 1.2.2.2 yamt spx_font.fontwidth, spx_font.fontheight);
1502 1.2.2.2 yamt }
1503 1.2.2.2 yamt
1504 1.2.2.2 yamt spx_cols = spx_xsize / spx_font.fontwidth;
1505 1.2.2.2 yamt spx_rows = spx_ysize / spx_font.fontheight;
1506 1.2.2.2 yamt spx_fb_size = spx_xsize * spx_ysize;
1507 1.2.2.2 yamt spx_stdscreen.ncols = spx_cols;
1508 1.2.2.2 yamt spx_stdscreen.nrows = spx_rows;
1509 1.2.2.2 yamt spx_stdscreen.fontwidth = spx_font.fontwidth;
1510 1.2.2.2 yamt spx_stdscreen.fontheight = spx_font.fontheight;
1511 1.2.2.2 yamt sprintf(spx_stdscreen_name, "%dx%d", spx_cols, spx_rows);
1512 1.2.2.2 yamt
1513 1.2.2.2 yamt /* for SPXg spx_fb_size represents FB window size, not FB length */
1514 1.2.2.2 yamt if (fb_type == FB_IS_SPXg)
1515 1.2.2.2 yamt spx_fb_size = SPXg_WIN_SIZE;
1516 1.2.2.2 yamt
1517 1.2.2.2 yamt qf = spx_font.data;
1518 1.2.2.2 yamt qf2 = (u_short *)spx_font.data;
1519 1.2.2.2 yamt
1520 1.2.2.2 yamt if (fb_type == FB_IS_SPX) {
1521 1.2.2.2 yamt SPX_MAP_FB(self, va, SPX);
1522 1.2.2.2 yamt } else if (fb_type == FB_IS_SPXg) {
1523 1.2.2.2 yamt SPX_MAP_FB(self, va, SPXg);
1524 1.2.2.2 yamt }
1525 1.2.2.2 yamt
1526 1.2.2.2 yamt /* render font glyphs to off-screen memory */
1527 1.2.2.2 yamt if (fb_type == FB_IS_SPX)
1528 1.2.2.2 yamt SPX_render_font();
1529 1.2.2.2 yamt else if (fb_type == FB_IS_SPXg)
1530 1.2.2.2 yamt SPXg_render_font();
1531 1.2.2.2 yamt
1532 1.2.2.2 yamt /* set up default console color palette */
1533 1.2.2.2 yamt for (i = 0; i < 8; i++) {
1534 1.2.2.2 yamt spx_cmap.r[i] = spx_default_cmap.r[i];
1535 1.2.2.2 yamt spx_cmap.g[i] = spx_default_cmap.g[i];
1536 1.2.2.2 yamt spx_cmap.b[i] = spx_default_cmap.b[i];
1537 1.2.2.2 yamt spx_update_cmap(i, spx_cmap.r[i], spx_cmap.g[i], spx_cmap.b[i]);
1538 1.2.2.2 yamt }
1539 1.2.2.2 yamt
1540 1.2.2.2 yamt /*
1541 1.2.2.2 yamt * Build 64x64 console cursor bitmap based on font dimensions.
1542 1.2.2.2 yamt * Palette colors are not used, but 4 pixels 2bpp of cursor sprite,
1543 1.2.2.2 yamt * fg/bg respectively.
1544 1.2.2.2 yamt */
1545 1.2.2.2 yamt for (i = 0; i < 1024; i++)
1546 1.2.2.2 yamt set_btreg(SPXDAC_REG_CRAM_BASE + i, 0);
1547 1.2.2.2 yamt
1548 1.2.2.2 yamt /* build cursor line, 1 to 3 pixels high depending on font height */
1549 1.2.2.2 yamt if (spx_font.fontheight > 26)
1550 1.2.2.2 yamt i = spx_font.fontheight - 3;
1551 1.2.2.2 yamt else if (spx_font.fontheight > 16)
1552 1.2.2.2 yamt i = spx_font.fontheight - 2;
1553 1.2.2.2 yamt else
1554 1.2.2.2 yamt i = spx_font.fontheight - 1;
1555 1.2.2.2 yamt
1556 1.2.2.2 yamt for (; i <= spx_font.fontheight - 1; i++) {
1557 1.2.2.2 yamt for (j = 0; j < (spx_font.fontwidth >> 2); j++)
1558 1.2.2.2 yamt set_btreg(SPXDAC_REG_CRAM_BASE + i*16 + j, 0xff);
1559 1.2.2.2 yamt k = (spx_font.fontwidth & 3) << 1;
1560 1.2.2.2 yamt set_btreg(SPXDAC_REG_CRAM_BASE + i*16 + j, (1 << k) - 1);
1561 1.2.2.2 yamt }
1562 1.2.2.2 yamt
1563 1.2.2.2 yamt if (fb_type == FB_IS_SPX) {
1564 1.2.2.2 yamt /* set SPX write/read plane masks */
1565 1.2.2.2 yamt SPX_REG(0x3170) = 0xffffffff;
1566 1.2.2.2 yamt SPX_REG(0x3174) = 0xffffffff;
1567 1.2.2.2 yamt }
1568 1.2.2.2 yamt
1569 1.2.2.2 yamt /* RAMDAC type-specific configuration */
1570 1.2.2.2 yamt if (fb_type == FB_IS_SPX)
1571 1.2.2.2 yamt set_btreg(SPXDAC_REG_CMD2, 0xc0);
1572 1.2.2.2 yamt
1573 1.2.2.2 yamt /* common configuration */
1574 1.2.2.2 yamt set_btreg(SPXDAC_REG_CMD0, 0x48);
1575 1.2.2.2 yamt set_btreg(SPXDAC_REG_CMD1, 0x00);
1576 1.2.2.2 yamt set_btreg(SPXDAC_REG_PRM, 0xff);
1577 1.2.2.2 yamt
1578 1.2.2.2 yamt set_btreg(SPXDAC_REG_CXLO, 0);
1579 1.2.2.2 yamt set_btreg(SPXDAC_REG_CXHI, 0);
1580 1.2.2.2 yamt set_btreg(SPXDAC_REG_CYLO, 0);
1581 1.2.2.2 yamt set_btreg(SPXDAC_REG_CYHI, 0);
1582 1.2.2.2 yamt
1583 1.2.2.2 yamt set_btreg(SPXDAC_REG_WXLO, 0);
1584 1.2.2.2 yamt set_btreg(SPXDAC_REG_WXHI, 0);
1585 1.2.2.2 yamt set_btreg(SPXDAC_REG_WYLO, 0);
1586 1.2.2.2 yamt set_btreg(SPXDAC_REG_WYHI, 0);
1587 1.2.2.2 yamt
1588 1.2.2.2 yamt set_btreg(SPXDAC_REG_WWLO, 0);
1589 1.2.2.2 yamt set_btreg(SPXDAC_REG_WWHI, 0);
1590 1.2.2.2 yamt set_btreg(SPXDAC_REG_WHLO, 0);
1591 1.2.2.2 yamt set_btreg(SPXDAC_REG_WHHI, 0);
1592 1.2.2.3 yamt
1593 1.2.2.3 yamt init_done = 1;
1594 1.2.2.2 yamt }
1595