stic.c revision 1.7 1 1.7 ad /* $NetBSD: stic.c,v 1.7 2001/01/09 16:04:03 ad Exp $ */
2 1.4 ad
3 1.4 ad /*-
4 1.7 ad * Copyright (c) 1999, 2000, 2001 The NetBSD Foundation, Inc.
5 1.4 ad * All rights reserved.
6 1.4 ad *
7 1.4 ad * This code is derived from software contributed to The NetBSD Foundation
8 1.4 ad * by Andrew Doran.
9 1.4 ad *
10 1.4 ad * Redistribution and use in source and binary forms, with or without
11 1.4 ad * modification, are permitted provided that the following conditions
12 1.4 ad * are met:
13 1.4 ad * 1. Redistributions of source code must retain the above copyright
14 1.4 ad * notice, this list of conditions and the following disclaimer.
15 1.4 ad * 2. Redistributions in binary form must reproduce the above copyright
16 1.4 ad * notice, this list of conditions and the following disclaimer in the
17 1.4 ad * documentation and/or other materials provided with the distribution.
18 1.4 ad * 3. All advertising materials mentioning features or use of this software
19 1.4 ad * must display the following acknowledgement:
20 1.4 ad * This product includes software developed by the NetBSD
21 1.4 ad * Foundation, Inc. and its contributors.
22 1.4 ad * 4. Neither the name of The NetBSD Foundation nor the names of its
23 1.4 ad * contributors may be used to endorse or promote products derived
24 1.4 ad * from this software without specific prior written permission.
25 1.4 ad *
26 1.4 ad * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 1.4 ad * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.4 ad * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.4 ad * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 1.4 ad * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.4 ad * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.4 ad * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.4 ad * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.4 ad * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.4 ad * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.4 ad * POSSIBILITY OF SUCH DAMAGE.
37 1.4 ad */
38 1.1 jonathan
39 1.1 jonathan /*
40 1.4 ad * Copyright (c) 1998, 1999 Tohru Nishimura. All rights reserved.
41 1.1 jonathan *
42 1.1 jonathan * Redistribution and use in source and binary forms, with or without
43 1.1 jonathan * modification, are permitted provided that the following conditions
44 1.1 jonathan * are met:
45 1.1 jonathan * 1. Redistributions of source code must retain the above copyright
46 1.1 jonathan * notice, this list of conditions and the following disclaimer.
47 1.1 jonathan * 2. Redistributions in binary form must reproduce the above copyright
48 1.1 jonathan * notice, this list of conditions and the following disclaimer in the
49 1.1 jonathan * documentation and/or other materials provided with the distribution.
50 1.1 jonathan * 3. All advertising materials mentioning features or use of this software
51 1.1 jonathan * must display the following acknowledgement:
52 1.4 ad * This product includes software developed by Tohru Nishimura
53 1.4 ad * for the NetBSD Project.
54 1.1 jonathan * 4. The name of the author may not be used to endorse or promote products
55 1.4 ad * derived from this software without specific prior written permission
56 1.1 jonathan *
57 1.1 jonathan * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
58 1.1 jonathan * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
59 1.1 jonathan * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
60 1.1 jonathan * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
61 1.1 jonathan * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
62 1.1 jonathan * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
63 1.1 jonathan * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
64 1.1 jonathan * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
65 1.1 jonathan * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
66 1.1 jonathan * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
67 1.1 jonathan */
68 1.1 jonathan
69 1.1 jonathan /*
70 1.4 ad * Driver for the DEC PixelStamp interface chip (STIC).
71 1.4 ad *
72 1.4 ad * XXX The bt459 interface shouldn't be replicated here.
73 1.1 jonathan */
74 1.1 jonathan
75 1.4 ad #include <sys/param.h>
76 1.4 ad #include <sys/systm.h>
77 1.4 ad #include <sys/kernel.h>
78 1.4 ad #include <sys/device.h>
79 1.4 ad #include <sys/malloc.h>
80 1.4 ad #include <sys/buf.h>
81 1.4 ad #include <sys/ioctl.h>
82 1.4 ad #include <sys/callout.h>
83 1.4 ad
84 1.4 ad #include <uvm/uvm_extern.h>
85 1.4 ad
86 1.4 ad #if defined(pmax)
87 1.4 ad #include <mips/cpuregs.h>
88 1.4 ad #elif defined(alpha)
89 1.4 ad #include <alpha/alpha_cpu.h>
90 1.4 ad #endif
91 1.4 ad
92 1.7 ad #include <machine/vmparam.h>
93 1.4 ad #include <machine/bus.h>
94 1.4 ad #include <machine/intr.h>
95 1.4 ad
96 1.4 ad #include <dev/wscons/wsconsio.h>
97 1.4 ad #include <dev/wscons/wsdisplayvar.h>
98 1.4 ad
99 1.4 ad #include <dev/wsfont/wsfont.h>
100 1.4 ad
101 1.4 ad #include <dev/ic/bt459reg.h>
102 1.4 ad
103 1.4 ad #include <dev/tc/tcvar.h>
104 1.4 ad #include <dev/tc/sticreg.h>
105 1.4 ad #include <dev/tc/sticvar.h>
106 1.4 ad
107 1.4 ad #define DUPBYTE0(x) ((((x)&0xff)<<16) | (((x)&0xff)<<8) | ((x)&0xff))
108 1.4 ad #define DUPBYTE1(x) ((((x)<<8)&0xff0000) | ((x)&0xff00) | (((x)>>8)&0xff))
109 1.4 ad #define DUPBYTE2(x) (((x)&0xff0000) | (((x)>>8)&0xff00) | (((x)>>16)&0xff))
110 1.4 ad
111 1.4 ad #define PACK(p, o) ((p)[(o)] | ((p)[(o)+1] << 16))
112 1.4 ad
113 1.4 ad #if defined(pmax)
114 1.4 ad #define machine_btop(x) mips_btop(x)
115 1.4 ad #elif defined(alpha)
116 1.4 ad #define machine_btop(x) alpha_btop(x)
117 1.4 ad #endif
118 1.4 ad
119 1.1 jonathan /*
120 1.4 ad * N.B., Bt459 registers are 8bit width. Some of TC framebuffers have
121 1.4 ad * obscure register layout such as 2nd and 3rd Bt459 registers are
122 1.4 ad * adjacent each other in a word, i.e.,
123 1.4 ad * struct bt459triplet {
124 1.4 ad * struct {
125 1.4 ad * u_int8_t u0;
126 1.4 ad * u_int8_t u1;
127 1.4 ad * u_int8_t u2;
128 1.4 ad * unsigned :8;
129 1.4 ad * } bt_lo;
130 1.4 ad * struct {
131 1.1 jonathan *
132 1.4 ad * Although HX has single Bt459, 32bit R/W can be done w/o any trouble.
133 1.4 ad * struct bt459reg {
134 1.4 ad * u_int32_t bt_lo;
135 1.4 ad * u_int32_t bt_hi;
136 1.4 ad * u_int32_t bt_reg;
137 1.4 ad * u_int32_t bt_cmap;
138 1.4 ad * };
139 1.1 jonathan *
140 1.1 jonathan */
141 1.1 jonathan
142 1.4 ad /* Bt459 hardware registers */
143 1.4 ad #define bt_lo 0
144 1.4 ad #define bt_hi 1
145 1.4 ad #define bt_reg 2
146 1.4 ad #define bt_cmap 3
147 1.4 ad
148 1.4 ad #define REG(base, index) *((u_int32_t *)(base) + (index))
149 1.4 ad #define SELECT(vdac, regno) do { \
150 1.4 ad REG(vdac, bt_lo) = DUPBYTE0(regno); \
151 1.4 ad REG(vdac, bt_hi) = DUPBYTE1(regno); \
152 1.4 ad tc_wmb(); \
153 1.4 ad } while (0)
154 1.4 ad
155 1.4 ad static int sticioctl(void *, u_long, caddr_t, int, struct proc *);
156 1.4 ad static paddr_t sticmmap(void *, off_t, int);
157 1.4 ad static int stic_alloc_screen(void *, const struct wsscreen_descr *,
158 1.4 ad void **, int *, int *, long *);
159 1.4 ad static void stic_free_screen(void *, void *);
160 1.4 ad static int stic_show_screen(void *, void *, int,
161 1.4 ad void (*) (void *, int, int), void *);
162 1.4 ad static void stic_do_switch(void *);
163 1.6 ad static void stic_setup_backing(struct stic_info *, struct stic_screen *);
164 1.7 ad static void stic_setup_vdac(struct stic_info *si);
165 1.4 ad
166 1.7 ad static int stic_get_cmap(struct stic_info *, struct wsdisplay_cmap *);
167 1.7 ad static int stic_set_cmap(struct stic_info *, struct wsdisplay_cmap *);
168 1.7 ad static int stic_set_cursor(struct stic_info *, struct wsdisplay_cursor *);
169 1.7 ad static int stic_get_cursor(struct stic_info *, struct wsdisplay_cursor *);
170 1.7 ad static void stic_set_curpos(struct stic_info *, struct wsdisplay_curpos *);
171 1.7 ad static void stic_set_hwcurpos(struct stic_info *);
172 1.4 ad
173 1.4 ad static void stic_cursor(void *, int, int, int);
174 1.4 ad static void stic_copycols(void *, int, int, int, int);
175 1.4 ad static void stic_copyrows(void *, int, int, int);
176 1.4 ad static void stic_erasecols(void *, int, int, int, long);
177 1.4 ad static void stic_eraserows(void *, int, int, long);
178 1.4 ad static int stic_mapchar(void *, int, u_int *);
179 1.4 ad static void stic_putchar(void *, int, int, u_int, long);
180 1.4 ad static int stic_alloc_attr(void *, int, int, int, long *);
181 1.4 ad
182 1.4 ad /* Colormap for wscons, matching WSCOL_*. Upper 8 are high-intensity. */
183 1.4 ad static const u_int8_t stic_cmap[16*3] = {
184 1.4 ad 0x00, 0x00, 0x00, /* black */
185 1.4 ad 0x7f, 0x00, 0x00, /* red */
186 1.4 ad 0x00, 0x7f, 0x00, /* green */
187 1.4 ad 0x7f, 0x7f, 0x00, /* brown */
188 1.4 ad 0x00, 0x00, 0x7f, /* blue */
189 1.4 ad 0x7f, 0x00, 0x7f, /* magenta */
190 1.4 ad 0x00, 0x7f, 0x7f, /* cyan */
191 1.4 ad 0xc7, 0xc7, 0xc7, /* white */
192 1.4 ad
193 1.4 ad 0x7f, 0x7f, 0x7f, /* black */
194 1.4 ad 0xff, 0x00, 0x00, /* red */
195 1.4 ad 0x00, 0xff, 0x00, /* green */
196 1.4 ad 0xff, 0xff, 0x00, /* brown */
197 1.4 ad 0x00, 0x00, 0xff, /* blue */
198 1.4 ad 0xff, 0x00, 0xff, /* magenta */
199 1.4 ad 0x00, 0xff, 0xff, /* cyan */
200 1.4 ad 0xff, 0xff, 0xff, /* white */
201 1.4 ad };
202 1.1 jonathan
203 1.1 jonathan /*
204 1.4 ad * Compose 2 bit/pixel cursor image. Bit order will be reversed.
205 1.4 ad * M M M M I I I I M I M I M I M I
206 1.4 ad * [ before ] [ after ]
207 1.4 ad * 3 2 1 0 3 2 1 0 0 0 1 1 2 2 3 3
208 1.4 ad * 7 6 5 4 7 6 5 4 4 4 5 5 6 6 7 7
209 1.1 jonathan */
210 1.4 ad static const u_int8_t shuffle[256] = {
211 1.4 ad 0x00, 0x40, 0x10, 0x50, 0x04, 0x44, 0x14, 0x54,
212 1.4 ad 0x01, 0x41, 0x11, 0x51, 0x05, 0x45, 0x15, 0x55,
213 1.4 ad 0x80, 0xc0, 0x90, 0xd0, 0x84, 0xc4, 0x94, 0xd4,
214 1.4 ad 0x81, 0xc1, 0x91, 0xd1, 0x85, 0xc5, 0x95, 0xd5,
215 1.4 ad 0x20, 0x60, 0x30, 0x70, 0x24, 0x64, 0x34, 0x74,
216 1.4 ad 0x21, 0x61, 0x31, 0x71, 0x25, 0x65, 0x35, 0x75,
217 1.4 ad 0xa0, 0xe0, 0xb0, 0xf0, 0xa4, 0xe4, 0xb4, 0xf4,
218 1.4 ad 0xa1, 0xe1, 0xb1, 0xf1, 0xa5, 0xe5, 0xb5, 0xf5,
219 1.4 ad 0x08, 0x48, 0x18, 0x58, 0x0c, 0x4c, 0x1c, 0x5c,
220 1.4 ad 0x09, 0x49, 0x19, 0x59, 0x0d, 0x4d, 0x1d, 0x5d,
221 1.4 ad 0x88, 0xc8, 0x98, 0xd8, 0x8c, 0xcc, 0x9c, 0xdc,
222 1.4 ad 0x89, 0xc9, 0x99, 0xd9, 0x8d, 0xcd, 0x9d, 0xdd,
223 1.4 ad 0x28, 0x68, 0x38, 0x78, 0x2c, 0x6c, 0x3c, 0x7c,
224 1.4 ad 0x29, 0x69, 0x39, 0x79, 0x2d, 0x6d, 0x3d, 0x7d,
225 1.4 ad 0xa8, 0xe8, 0xb8, 0xf8, 0xac, 0xec, 0xbc, 0xfc,
226 1.4 ad 0xa9, 0xe9, 0xb9, 0xf9, 0xad, 0xed, 0xbd, 0xfd,
227 1.4 ad 0x02, 0x42, 0x12, 0x52, 0x06, 0x46, 0x16, 0x56,
228 1.4 ad 0x03, 0x43, 0x13, 0x53, 0x07, 0x47, 0x17, 0x57,
229 1.4 ad 0x82, 0xc2, 0x92, 0xd2, 0x86, 0xc6, 0x96, 0xd6,
230 1.4 ad 0x83, 0xc3, 0x93, 0xd3, 0x87, 0xc7, 0x97, 0xd7,
231 1.4 ad 0x22, 0x62, 0x32, 0x72, 0x26, 0x66, 0x36, 0x76,
232 1.4 ad 0x23, 0x63, 0x33, 0x73, 0x27, 0x67, 0x37, 0x77,
233 1.4 ad 0xa2, 0xe2, 0xb2, 0xf2, 0xa6, 0xe6, 0xb6, 0xf6,
234 1.4 ad 0xa3, 0xe3, 0xb3, 0xf3, 0xa7, 0xe7, 0xb7, 0xf7,
235 1.4 ad 0x0a, 0x4a, 0x1a, 0x5a, 0x0e, 0x4e, 0x1e, 0x5e,
236 1.4 ad 0x0b, 0x4b, 0x1b, 0x5b, 0x0f, 0x4f, 0x1f, 0x5f,
237 1.4 ad 0x8a, 0xca, 0x9a, 0xda, 0x8e, 0xce, 0x9e, 0xde,
238 1.4 ad 0x8b, 0xcb, 0x9b, 0xdb, 0x8f, 0xcf, 0x9f, 0xdf,
239 1.4 ad 0x2a, 0x6a, 0x3a, 0x7a, 0x2e, 0x6e, 0x3e, 0x7e,
240 1.4 ad 0x2b, 0x6b, 0x3b, 0x7b, 0x2f, 0x6f, 0x3f, 0x7f,
241 1.4 ad 0xaa, 0xea, 0xba, 0xfa, 0xae, 0xee, 0xbe, 0xfe,
242 1.4 ad 0xab, 0xeb, 0xbb, 0xfb, 0xaf, 0xef, 0xbf, 0xff,
243 1.4 ad };
244 1.4 ad
245 1.4 ad static const struct wsdisplay_accessops stic_accessops = {
246 1.4 ad sticioctl,
247 1.4 ad sticmmap,
248 1.4 ad stic_alloc_screen,
249 1.4 ad stic_free_screen,
250 1.4 ad stic_show_screen,
251 1.4 ad 0 /* load_font */
252 1.4 ad };
253 1.4 ad
254 1.4 ad static const struct wsdisplay_emulops stic_emulops = {
255 1.4 ad stic_cursor,
256 1.4 ad stic_mapchar,
257 1.4 ad stic_putchar,
258 1.4 ad stic_copycols,
259 1.4 ad stic_erasecols,
260 1.4 ad stic_copyrows,
261 1.4 ad stic_eraserows,
262 1.4 ad stic_alloc_attr
263 1.4 ad };
264 1.4 ad
265 1.4 ad static struct wsscreen_descr stic_stdscreen = {
266 1.4 ad "std",
267 1.4 ad 0, 0,
268 1.4 ad &stic_emulops,
269 1.4 ad 0, 0,
270 1.4 ad WSATTR_REVERSE | WSATTR_HILIT | WSATTR_WSCOLORS
271 1.4 ad };
272 1.4 ad
273 1.4 ad static const struct wsscreen_descr *_stic_scrlist[] = {
274 1.4 ad &stic_stdscreen,
275 1.4 ad };
276 1.4 ad
277 1.4 ad static const struct wsscreen_list stic_screenlist = {
278 1.4 ad sizeof(_stic_scrlist) / sizeof(struct wsscreen_descr *), _stic_scrlist
279 1.4 ad };
280 1.1 jonathan
281 1.4 ad struct stic_info stic_consinfo;
282 1.4 ad static struct stic_screen stic_consscr;
283 1.1 jonathan
284 1.4 ad void
285 1.4 ad stic_init(struct stic_info *si)
286 1.4 ad {
287 1.4 ad volatile u_int32_t *vdac;
288 1.4 ad int i, cookie;
289 1.1 jonathan
290 1.4 ad /* Reset the STIC & stamp(s). */
291 1.4 ad stic_reset(si);
292 1.4 ad vdac = si->si_vdac;
293 1.4 ad
294 1.4 ad /* Hit it... */
295 1.4 ad SELECT(vdac, BT459_IREG_COMMAND_0);
296 1.4 ad REG(vdac, bt_reg) = 0x00c0c0c0; tc_syncbus();
297 1.4 ad
298 1.4 ad /* Now reset the VDAC. */
299 1.4 ad *si->si_vdac_reset = 0;
300 1.4 ad tc_syncbus();
301 1.4 ad DELAY(1000);
302 1.4 ad
303 1.4 ad /* Finish the initalization. */
304 1.4 ad SELECT(vdac, BT459_IREG_COMMAND_1);
305 1.4 ad REG(vdac, bt_reg) = 0x00000000; tc_wmb();
306 1.4 ad REG(vdac, bt_reg) = 0x00c2c2c2; tc_wmb();
307 1.4 ad REG(vdac, bt_reg) = 0x00ffffff; tc_wmb();
308 1.4 ad
309 1.4 ad for (i = 0; i < 7; i++) {
310 1.4 ad REG(vdac, bt_reg) = 0x00000000;
311 1.4 ad tc_wmb();
312 1.4 ad }
313 1.1 jonathan
314 1.4 ad /* Set cursor colormap. */
315 1.4 ad SELECT(vdac, BT459_IREG_CCOLOR_1);
316 1.4 ad REG(vdac, bt_reg) = 0x00ffffff; tc_wmb();
317 1.4 ad REG(vdac, bt_reg) = 0x00ffffff; tc_wmb();
318 1.4 ad REG(vdac, bt_reg) = 0x00ffffff; tc_wmb();
319 1.4 ad REG(vdac, bt_reg) = 0x00000000; tc_wmb();
320 1.4 ad REG(vdac, bt_reg) = 0x00000000; tc_wmb();
321 1.4 ad REG(vdac, bt_reg) = 0x00000000; tc_wmb();
322 1.4 ad REG(vdac, bt_reg) = 0x00ffffff; tc_wmb();
323 1.4 ad REG(vdac, bt_reg) = 0x00ffffff; tc_wmb();
324 1.4 ad REG(vdac, bt_reg) = 0x00ffffff; tc_wmb();
325 1.4 ad
326 1.4 ad /* Get a font and set up screen metrics. */
327 1.4 ad wsfont_init();
328 1.4 ad cookie = wsfont_find(NULL, 0, 0, 0);
329 1.4 ad
330 1.4 ad if (wsfont_lock(cookie, &si->si_font,
331 1.4 ad WSDISPLAY_FONTORDER_R2L, WSDISPLAY_FONTORDER_L2R) <= 0)
332 1.4 ad panic("stic_init: couldn't lock font\n");
333 1.4 ad
334 1.6 ad si->si_fontw = si->si_font->fontwidth;
335 1.4 ad si->si_fonth = si->si_font->fontheight;
336 1.6 ad si->si_consw = (1280 / si->si_fontw) & ~1;
337 1.4 ad si->si_consh = 1024 / si->si_fonth;
338 1.6 ad stic_stdscreen.ncols = si->si_consw;
339 1.4 ad stic_stdscreen.nrows = si->si_consh;
340 1.4 ad
341 1.4 ad #ifdef DIAGNOSTIC
342 1.4 ad if ((u_int)si->si_fonth > 32 || (u_int)si->si_fontw > 16)
343 1.4 ad panic("stic_init: unusable font");
344 1.4 ad #endif
345 1.7 ad
346 1.7 ad stic_setup_vdac(si);
347 1.4 ad }
348 1.1 jonathan
349 1.4 ad void
350 1.4 ad stic_reset(struct stic_info *si)
351 1.1 jonathan {
352 1.1 jonathan int modtype, xconfig, yconfig, config;
353 1.4 ad volatile struct stic_regs *sr;
354 1.4 ad
355 1.4 ad sr = si->si_stic;
356 1.1 jonathan
357 1.1 jonathan /*
358 1.4 ad * Initialize the interface chip registers.
359 1.1 jonathan */
360 1.4 ad sr->sr_sticsr = 0x00000030; /* Get the STIC's attention. */
361 1.4 ad tc_syncbus();
362 1.1 jonathan DELAY(4000); /* wait 4ms for STIC to respond. */
363 1.4 ad sr->sr_sticsr = 0x00000000; /* Hit the STIC's csr again... */
364 1.4 ad tc_syncbus();
365 1.4 ad sr->sr_buscsr = 0xffffffff; /* and bash its bus-acess csr. */
366 1.4 ad tc_syncbus(); /* Blam! */
367 1.1 jonathan DELAY(20000); /* wait until the stic recovers... */
368 1.1 jonathan
369 1.4 ad modtype = sr->sr_modcl;
370 1.4 ad xconfig = (modtype & 0x800) >> 11;
371 1.4 ad yconfig = (modtype & 0x600) >> 9;
372 1.4 ad config = (yconfig << 1) | xconfig;
373 1.4 ad si->si_stampw = (xconfig ? 5 : 4);
374 1.4 ad si->si_stamph = (1 << yconfig);
375 1.1 jonathan #ifdef notyet
376 1.4 ad si->si_option = (char)((modtype >> 12) & 3);
377 1.1 jonathan #endif
378 1.1 jonathan
379 1.4 ad /* First PixelStamp */
380 1.4 ad si->si_stamp[0x000b0] = config;
381 1.4 ad si->si_stamp[0x000b4] = 0x0;
382 1.4 ad
383 1.4 ad /* Second PixelStamp */
384 1.4 ad if (yconfig > 0) {
385 1.4 ad si->si_stamp[0x100b0] = config | 8;
386 1.4 ad si->si_stamp[0x100b4] = 0;
387 1.4 ad }
388 1.4 ad
389 1.1 jonathan /*
390 1.4 ad * Initialize STIC video registers.
391 1.1 jonathan */
392 1.4 ad sr->sr_vblank = (1024 << 16) | 1063;
393 1.4 ad sr->sr_vsync = (1027 << 16) | 1030;
394 1.4 ad sr->sr_hblank = (255 << 16) | 340;
395 1.4 ad sr->sr_hsync2 = 245;
396 1.4 ad sr->sr_hsync = (261 << 16) | 293;
397 1.4 ad sr->sr_ipdvint = STIC_INT_CLR | STIC_INT_WE;
398 1.4 ad sr->sr_sticsr = 8;
399 1.4 ad tc_wmb();
400 1.4 ad }
401 1.4 ad
402 1.4 ad void
403 1.4 ad stic_attach(struct device *self, struct stic_info *si, int console)
404 1.4 ad {
405 1.4 ad struct wsemuldisplaydev_attach_args waa;
406 1.4 ad
407 1.4 ad callout_init(&si->si_switch_callout);
408 1.1 jonathan
409 1.1 jonathan /*
410 1.4 ad * Allocate backing for the console. We could trawl back through
411 1.4 ad * msgbuf and and fill the backing, but it's not worth the hassle.
412 1.4 ad * We could also grab backing using pmap_steal_memory() early on,
413 1.4 ad * but that's a little ugly.
414 1.1 jonathan */
415 1.4 ad if (console)
416 1.6 ad stic_setup_backing(si, &stic_consscr);
417 1.4 ad
418 1.4 ad waa.console = console;
419 1.4 ad waa.scrdata = &stic_screenlist;
420 1.4 ad waa.accessops = &stic_accessops;
421 1.4 ad waa.accesscookie = si;
422 1.4 ad config_found(self, &waa, wsemuldisplaydevprint);
423 1.4 ad }
424 1.4 ad
425 1.4 ad void
426 1.4 ad stic_cnattach(struct stic_info *si)
427 1.4 ad {
428 1.4 ad struct stic_screen *ss;
429 1.4 ad long defattr;
430 1.4 ad
431 1.4 ad ss = &stic_consscr;
432 1.4 ad si->si_curscreen = ss;
433 1.7 ad ss->ss_flags = SS_ALLOCED | SS_ACTIVE;
434 1.4 ad ss->ss_si = si;
435 1.4 ad
436 1.7 ad si->si_flags |= SI_CURENB | SI_CURENB_CHANGED;
437 1.4 ad stic_flush(si);
438 1.4 ad
439 1.6 ad stic_alloc_attr(ss, WSCOL_WHITE, 0, 0, &defattr);
440 1.7 ad stic_eraserows(ss, 0, si->si_consh, 0);
441 1.4 ad wsdisplay_cnattach(&stic_stdscreen, ss, 0, 0, defattr);
442 1.4 ad }
443 1.4 ad
444 1.4 ad static void
445 1.7 ad stic_setup_vdac(struct stic_info *si)
446 1.4 ad {
447 1.4 ad u_int8_t *ip, *mp;
448 1.4 ad int r, c, o, b;
449 1.4 ad
450 1.7 ad ip = (u_int8_t *)si->si_cursor.cc_image;
451 1.7 ad mp = ip + (sizeof(si->si_cursor.cc_image) >> 1);
452 1.7 ad memset(ip, 0, sizeof(si->si_cursor.cc_image));
453 1.4 ad
454 1.4 ad for (r = 0; r < si->si_fonth; r++) {
455 1.4 ad for (c = 0; c < si->si_fontw; c++) {
456 1.4 ad o = c >> 3;
457 1.4 ad b = 1 << (c & 7);
458 1.4 ad ip[o] |= b;
459 1.4 ad mp[o] |= b;
460 1.4 ad }
461 1.4 ad
462 1.4 ad ip += 16;
463 1.4 ad mp += 16;
464 1.4 ad }
465 1.4 ad
466 1.7 ad si->si_cursor.cc_size.x = 64;
467 1.7 ad si->si_cursor.cc_size.y = si->si_fonth;
468 1.7 ad si->si_cursor.cc_hot.x = 0;
469 1.7 ad si->si_cursor.cc_hot.y = 0;
470 1.7 ad
471 1.7 ad si->si_cursor.cc_color[0] = 0xff;
472 1.7 ad si->si_cursor.cc_color[2] = 0xff;
473 1.7 ad si->si_cursor.cc_color[4] = 0xff;
474 1.7 ad si->si_cursor.cc_color[1] = 0x00;
475 1.7 ad si->si_cursor.cc_color[3] = 0x00;
476 1.7 ad si->si_cursor.cc_color[5] = 0x00;
477 1.4 ad
478 1.7 ad memset(&si->si_cmap, 0, sizeof(si->si_cmap));
479 1.7 ad for (i = 0; i < 16; i++) {
480 1.7 ad si->si_cmap.r[i] = stic_cmap[i*3 + 0];
481 1.7 ad si->si_cmap.g[i] = stic_cmap[i*3 + 1];
482 1.7 ad si->si_cmap.b[i] = stic_cmap[i*3 + 2];
483 1.7 ad }
484 1.7 ad
485 1.7 ad si->si_flags |= SI_CMAP_CHANGED | SI_CURSHAPE_CHANGED |
486 1.7 ad SI_CURCMAP_CHANGED;
487 1.4 ad }
488 1.4 ad
489 1.4 ad static int
490 1.4 ad sticioctl(void *v, u_long cmd, caddr_t data, int flag, struct proc *p)
491 1.4 ad {
492 1.4 ad struct stic_info *si;
493 1.4 ad struct stic_xinfo *sxi;
494 1.4 ad
495 1.7 ad si = v;
496 1.4 ad
497 1.4 ad switch (cmd) {
498 1.4 ad case WSDISPLAYIO_GTYPE:
499 1.4 ad *(u_int *)data = si->si_disptype;
500 1.4 ad return (0);
501 1.4 ad
502 1.4 ad case WSDISPLAYIO_GINFO:
503 1.4 ad #define wsd_fbip ((struct wsdisplay_fbinfo *)data)
504 1.4 ad wsd_fbip->height = 1024;
505 1.4 ad wsd_fbip->width = 1280;
506 1.7 ad wsd_fbip->depth = si->si_depth == 8 ? 8 : 32;
507 1.4 ad wsd_fbip->cmsize = CMAP_SIZE;
508 1.4 ad #undef fbt
509 1.4 ad return (0);
510 1.4 ad
511 1.4 ad case WSDISPLAYIO_GETCMAP:
512 1.7 ad return (stic_get_cmap(si, (struct wsdisplay_cmap *)data));
513 1.4 ad
514 1.4 ad case WSDISPLAYIO_PUTCMAP:
515 1.7 ad return (stic_set_cmap(si, (struct wsdisplay_cmap *)data));
516 1.4 ad
517 1.4 ad case WSDISPLAYIO_SVIDEO:
518 1.4 ad #if 0 /* XXX later */
519 1.4 ad turnoff = *(int *)data == WSDISPLAYIO_VIDEO_OFF;
520 1.4 ad if ((si->si_blanked == 0) ^ turnoff)
521 1.4 ad si->si_blanked = turnoff;
522 1.4 ad #endif
523 1.4 ad return (0);
524 1.4 ad
525 1.4 ad case WSDISPLAYIO_GVIDEO:
526 1.4 ad #if 0 /* XXX later */
527 1.4 ad *(u_int *)data = si->si_blanked ?
528 1.4 ad WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON;
529 1.4 ad #endif
530 1.4 ad return (0);
531 1.4 ad
532 1.4 ad case WSDISPLAYIO_GCURPOS:
533 1.7 ad *(struct wsdisplay_curpos *)data = si->si_cursor.cc_pos;
534 1.4 ad return (0);
535 1.4 ad
536 1.4 ad case WSDISPLAYIO_SCURPOS:
537 1.7 ad stic_set_curpos(si, (struct wsdisplay_curpos *)data);
538 1.4 ad return (0);
539 1.4 ad
540 1.4 ad case WSDISPLAYIO_GCURMAX:
541 1.4 ad ((struct wsdisplay_curpos *)data)->x =
542 1.4 ad ((struct wsdisplay_curpos *)data)->y = CURSOR_MAX_SIZE;
543 1.4 ad return (0);
544 1.4 ad
545 1.4 ad case WSDISPLAYIO_GCURSOR:
546 1.7 ad return (stic_get_cursor(si, (struct wsdisplay_cursor *)data));
547 1.4 ad
548 1.4 ad case WSDISPLAYIO_SCURSOR:
549 1.7 ad return (stic_set_cursor(si, (struct wsdisplay_cursor *)data));
550 1.7 ad
551 1.7 ad case STICIO_RESET:
552 1.7 ad stic_reset(si);
553 1.7 ad return (0);
554 1.7 ad
555 1.7 ad case STICIO_RESTORE:
556 1.7 ad stic_setup_vdac(si);
557 1.7 ad stic_flush(si);
558 1.7 ad stic_do_switch(si->si_curscreen);
559 1.7 ad return (0);
560 1.4 ad
561 1.4 ad case STICIO_GXINFO:
562 1.4 ad sxi = (struct stic_xinfo *)data;
563 1.4 ad sxi->sxi_stampw = si->si_stampw;
564 1.4 ad sxi->sxi_stamph = si->si_stamph;
565 1.4 ad sxi->sxi_buf_size = si->si_buf_size;
566 1.4 ad sxi->sxi_buf_phys = (u_long)si->si_buf_phys;
567 1.6 ad return (0);
568 1.4 ad }
569 1.4 ad
570 1.6 ad if (si->si_ioctl != NULL)
571 1.6 ad return ((*si->si_ioctl)(si, cmd, data, flag, p));
572 1.4 ad return (ENOTTY);
573 1.4 ad }
574 1.4 ad
575 1.4 ad static paddr_t
576 1.4 ad sticmmap(void *v, off_t offset, int prot)
577 1.4 ad {
578 1.6 ad struct stic_info *si;
579 1.4 ad struct stic_xmap sxm;
580 1.4 ad paddr_t pa;
581 1.4 ad
582 1.6 ad si = v;
583 1.4 ad
584 1.4 ad if (offset < 0)
585 1.4 ad return ((paddr_t)-1L);
586 1.4 ad
587 1.4 ad if (offset < sizeof(sxm.sxm_stic)) {
588 1.4 ad pa = STIC_KSEG_TO_PHYS(si->si_stic);
589 1.6 ad return (machine_btop(pa + offset));
590 1.4 ad }
591 1.4 ad offset -= sizeof(sxm.sxm_stic);
592 1.4 ad
593 1.4 ad if (offset < sizeof(sxm.sxm_poll)) {
594 1.6 ad pa = STIC_KSEG_TO_PHYS(si->si_slotkva);
595 1.6 ad return (machine_btop(pa + offset));
596 1.4 ad }
597 1.5 ad offset -= sizeof(sxm.sxm_poll);
598 1.4 ad
599 1.4 ad if (offset < si->si_buf_size) {
600 1.4 ad pa = STIC_KSEG_TO_PHYS(si->si_buf_phys);
601 1.6 ad return (machine_btop(pa + offset));
602 1.4 ad }
603 1.4 ad
604 1.4 ad return ((paddr_t)-1L);
605 1.4 ad }
606 1.4 ad
607 1.6 ad static void
608 1.6 ad stic_setup_backing(struct stic_info *si, struct stic_screen *ss)
609 1.4 ad {
610 1.4 ad int size;
611 1.4 ad
612 1.4 ad size = si->si_consw * si->si_consh * sizeof(*ss->ss_backing);
613 1.6 ad ss->ss_backing = malloc(size, M_DEVBUF, M_NOWAIT);
614 1.4 ad memset(ss->ss_backing, 0, size);
615 1.4 ad }
616 1.4 ad
617 1.4 ad static int
618 1.4 ad stic_alloc_screen(void *v, const struct wsscreen_descr *type, void **cookiep,
619 1.4 ad int *curxp, int *curyp, long *attrp)
620 1.4 ad {
621 1.4 ad struct stic_info *si;
622 1.4 ad struct stic_screen *ss;
623 1.4 ad
624 1.4 ad si = (struct stic_info *)v;
625 1.6 ad
626 1.6 ad if ((stic_consscr.ss_flags & SS_ALLOCED) == 0)
627 1.4 ad ss = &stic_consscr;
628 1.6 ad else {
629 1.6 ad ss = malloc(sizeof(*ss), M_DEVBUF, M_WAITOK);
630 1.4 ad memset(ss, 0, sizeof(*ss));
631 1.4 ad }
632 1.6 ad stic_setup_backing(si, ss);
633 1.4 ad
634 1.4 ad ss->ss_si = si;
635 1.7 ad ss->ss_flags = SS_ALLOCED;
636 1.4 ad
637 1.4 ad *cookiep = ss;
638 1.4 ad *curxp = 0;
639 1.4 ad *curyp = 0;
640 1.4 ad
641 1.6 ad stic_alloc_attr(ss, WSCOL_WHITE, 0, 0, attrp);
642 1.4 ad return (0);
643 1.4 ad }
644 1.4 ad
645 1.4 ad static void
646 1.4 ad stic_free_screen(void *v, void *cookie)
647 1.4 ad {
648 1.4 ad struct stic_screen *ss;
649 1.4 ad
650 1.4 ad ss = cookie;
651 1.4 ad
652 1.4 ad #ifdef DIAGNOSTIC
653 1.4 ad if (ss == &stic_consscr)
654 1.4 ad panic("stic_free_screen: console");
655 1.4 ad if (ss == ((struct stic_info *)v)->si_curscreen)
656 1.4 ad panic("stic_free_screen: freeing current screen");
657 1.4 ad #endif
658 1.4 ad
659 1.4 ad free(ss->ss_backing, M_DEVBUF);
660 1.4 ad free(ss, M_DEVBUF);
661 1.4 ad }
662 1.4 ad
663 1.4 ad static int
664 1.4 ad stic_show_screen(void *v, void *cookie, int waitok,
665 1.4 ad void (*cb)(void *, int, int), void *cbarg)
666 1.4 ad {
667 1.4 ad struct stic_info *si;
668 1.4 ad
669 1.4 ad si = (struct stic_info *)v;
670 1.4 ad if (si->si_switchcbarg != NULL)
671 1.4 ad return (EAGAIN);
672 1.4 ad si->si_switchcb = cb;
673 1.4 ad si->si_switchcbarg = cbarg;
674 1.4 ad
675 1.4 ad if (cb != NULL) {
676 1.4 ad callout_reset(&si->si_switch_callout, 0, stic_do_switch,
677 1.4 ad cookie);
678 1.4 ad return (EAGAIN);
679 1.4 ad }
680 1.4 ad
681 1.4 ad stic_do_switch(cookie);
682 1.4 ad return (0);
683 1.4 ad }
684 1.4 ad
685 1.4 ad static void
686 1.4 ad stic_do_switch(void *cookie)
687 1.4 ad {
688 1.4 ad struct stic_screen *ss;
689 1.4 ad struct stic_info *si;
690 1.4 ad u_int r, c, nr, nc;
691 1.4 ad u_int16_t *p, *sp;
692 1.4 ad
693 1.4 ad ss = cookie;
694 1.4 ad si = ss->ss_si;
695 1.4 ad
696 1.4 ad #ifdef DIAGNOSTIC
697 1.4 ad if (ss->ss_backing == NULL)
698 1.4 ad panic("stic_do_switch: screen not backed");
699 1.4 ad #endif
700 1.4 ad
701 1.4 ad /* Swap in the new screen, and temporarily disable its backing. */
702 1.4 ad si->si_curscreen->ss_flags ^= SS_ACTIVE;
703 1.4 ad si->si_curscreen = ss;
704 1.4 ad ss->ss_flags |= SS_ACTIVE;
705 1.4 ad sp = ss->ss_backing;
706 1.4 ad ss->ss_backing = NULL;
707 1.4 ad
708 1.4 ad /*
709 1.4 ad * We assume that most of the screen is blank and blast it with
710 1.4 ad * eraserows(), because eraserows() is cheap.
711 1.4 ad */
712 1.4 ad nr = si->si_consh;
713 1.4 ad stic_eraserows(ss, 0, nr, 0);
714 1.4 ad
715 1.4 ad nc = si->si_consw;
716 1.4 ad p = sp;
717 1.4 ad for (r = 0; r < nr; r++)
718 1.4 ad for (c = 0; c < nc; c += 2, p += 2) {
719 1.4 ad if ((p[0] & 0xfff0) != 0)
720 1.4 ad stic_putchar(ss, r, c, p[0] >> 8,
721 1.4 ad p[0] & 0x00ff);
722 1.4 ad if ((p[1] & 0xfff0) != 0)
723 1.7 ad stic_putchar(ss, r, c + 1, p[1] >> 8,
724 1.4 ad p[1] & 0x00ff);
725 1.4 ad }
726 1.4 ad
727 1.7 ad /*
728 1.7 ad * Re-enable the screen's backing, and move the cursor to the
729 1.7 ad * correct spot.
730 1.7 ad */
731 1.4 ad ss->ss_backing = sp;
732 1.7 ad si->si_cursor.cc_pos.x = ss->ss_curx;
733 1.7 ad si->si_cursor.cc_pos.y = ss->ss_cury;
734 1.7 ad stic_set_hwcurpos(si);
735 1.4 ad
736 1.4 ad /* Tell wscons that we're done. */
737 1.4 ad if (si->si_switchcbarg != NULL) {
738 1.4 ad cookie = si->si_switchcbarg;
739 1.4 ad si->si_switchcbarg = NULL;
740 1.4 ad (*si->si_switchcb)(cookie, 0, 0);
741 1.4 ad }
742 1.4 ad }
743 1.4 ad
744 1.4 ad static int
745 1.4 ad stic_alloc_attr(void *cookie, int fg, int bg, int flags, long *attr)
746 1.4 ad {
747 1.4 ad long tmp;
748 1.4 ad int swap;
749 1.4 ad
750 1.4 ad if ((flags & (WSATTR_BLINK | WSATTR_UNDERLINE)) != 0)
751 1.4 ad return (EINVAL);
752 1.4 ad
753 1.4 ad if ((flags & WSATTR_HILIT) != 0)
754 1.4 ad fg += 8;
755 1.4 ad
756 1.4 ad if ((flags & WSATTR_REVERSE) != 0) {
757 1.4 ad swap = fg;
758 1.4 ad fg = bg;
759 1.4 ad bg = swap;
760 1.4 ad }
761 1.4 ad
762 1.4 ad tmp = fg | (bg << 4);
763 1.4 ad *attr = tmp | (tmp << 16);
764 1.4 ad return (0);
765 1.4 ad }
766 1.4 ad
767 1.4 ad static void
768 1.4 ad stic_erasecols(void *cookie, int row, int col, int num, long attr)
769 1.4 ad {
770 1.4 ad struct stic_info *si;
771 1.4 ad struct stic_screen *ss;
772 1.4 ad u_int32_t *pb;
773 1.4 ad u_int i, linewidth;
774 1.4 ad u_int16_t *p;
775 1.4 ad
776 1.4 ad ss = cookie;
777 1.4 ad si = ss->ss_si;
778 1.4 ad
779 1.4 ad if (ss->ss_backing != NULL) {
780 1.4 ad p = ss->ss_backing + row * si->si_consw + col;
781 1.4 ad for (i = num; i != 0; i--)
782 1.4 ad *p++ = (u_int16_t)attr;
783 1.4 ad }
784 1.4 ad if ((ss->ss_flags & SS_ACTIVE) == 0)
785 1.4 ad return;
786 1.4 ad
787 1.4 ad si = (struct stic_info *)cookie;
788 1.4 ad col = (col * si->si_fontw) << 19;
789 1.4 ad num = (num * si->si_fontw) << 19;
790 1.4 ad row = row * si->si_fonth;
791 1.4 ad attr = (attr & 0xf0) >> 4;
792 1.4 ad
793 1.4 ad pb = (*si->si_pbuf_get)(si);
794 1.4 ad
795 1.4 ad linewidth = (si->si_fonth << 2) - 1;
796 1.4 ad row = (row << 3) + linewidth;
797 1.4 ad
798 1.4 ad pb[0] = STAMP_CMD_LINES | STAMP_RGB_CONST | STAMP_LW_PERPACKET;
799 1.4 ad pb[1] = 0x01ffffff;
800 1.4 ad pb[2] = 0;
801 1.4 ad pb[3] = STAMP_UPDATE_ENABLE | STAMP_METHOD_COPY;
802 1.4 ad pb[4] = linewidth;
803 1.4 ad pb[5] = DUPBYTE0(attr);
804 1.4 ad pb[6] = col | row;
805 1.4 ad pb[7] = (col + num) | row;
806 1.4 ad
807 1.4 ad (*si->si_pbuf_post)(si, pb);
808 1.4 ad }
809 1.4 ad
810 1.4 ad static void
811 1.4 ad stic_eraserows(void *cookie, int row, int num, long attr)
812 1.4 ad {
813 1.4 ad struct stic_info *si;
814 1.4 ad struct stic_screen *ss;
815 1.4 ad u_int linewidth, i;
816 1.4 ad u_int32_t *pb;
817 1.4 ad
818 1.4 ad ss = cookie;
819 1.4 ad si = ss->ss_si;
820 1.4 ad
821 1.4 ad if (ss->ss_backing != NULL) {
822 1.4 ad pb = (u_int32_t *)(ss->ss_backing + row * si->si_consw);
823 1.6 ad for (i = si->si_consw * num; i > 0; i -= 2)
824 1.4 ad *pb++ = (u_int32_t)attr;
825 1.4 ad }
826 1.4 ad if ((ss->ss_flags & SS_ACTIVE) == 0)
827 1.4 ad return;
828 1.4 ad
829 1.4 ad row *= si->si_fonth;
830 1.4 ad num *= si->si_fonth;
831 1.4 ad attr = (attr & 0xf0) >> 4;
832 1.4 ad
833 1.4 ad pb = (*si->si_pbuf_get)(si);
834 1.4 ad
835 1.4 ad linewidth = (num << 2) - 1;
836 1.4 ad row = (row << 3) + linewidth;
837 1.4 ad
838 1.4 ad pb[0] = STAMP_CMD_LINES | STAMP_RGB_CONST | STAMP_LW_PERPACKET;
839 1.4 ad pb[1] = 0x01ffffff;
840 1.4 ad pb[2] = 0;
841 1.4 ad pb[3] = STAMP_UPDATE_ENABLE | STAMP_METHOD_COPY;
842 1.4 ad pb[4] = linewidth;
843 1.4 ad pb[5] = DUPBYTE0(attr);
844 1.4 ad pb[6] = row;
845 1.4 ad pb[7] = (1280 << 19) | row;
846 1.4 ad
847 1.4 ad (*si->si_pbuf_post)(si, pb);
848 1.4 ad }
849 1.4 ad
850 1.4 ad static void
851 1.4 ad stic_copyrows(void *cookie, int src, int dst, int height)
852 1.4 ad {
853 1.4 ad struct stic_info *si;
854 1.4 ad struct stic_screen *ss;
855 1.4 ad u_int32_t *pb, *pbs;
856 1.4 ad u_int num, inc, adj;
857 1.4 ad
858 1.4 ad ss = cookie;
859 1.4 ad si = ss->ss_si;
860 1.4 ad
861 1.4 ad if (ss->ss_backing != NULL)
862 1.4 ad bcopy(ss->ss_backing + src * si->si_consw,
863 1.4 ad ss->ss_backing + dst * si->si_consw,
864 1.4 ad si->si_consw * sizeof(*ss->ss_backing) * height);
865 1.4 ad if ((ss->ss_flags & SS_ACTIVE) == 0)
866 1.4 ad return;
867 1.4 ad
868 1.4 ad /*
869 1.4 ad * We need to do this in reverse if the destination row is below
870 1.4 ad * the source.
871 1.4 ad */
872 1.4 ad if (dst > src) {
873 1.4 ad src += height;
874 1.4 ad dst += height;
875 1.4 ad inc = -8;
876 1.4 ad adj = -1;
877 1.4 ad } else {
878 1.4 ad inc = 8;
879 1.4 ad adj = 0;
880 1.4 ad }
881 1.4 ad
882 1.4 ad src = (src * si->si_fonth + adj) << 3;
883 1.4 ad dst = (dst * si->si_fonth + adj) << 3;
884 1.4 ad height *= si->si_fonth;
885 1.4 ad
886 1.4 ad while (height > 0) {
887 1.4 ad num = (height < 255 ? height : 255);
888 1.4 ad height -= num;
889 1.4 ad
890 1.4 ad pbs = (*si->si_pbuf_get)(si);
891 1.4 ad pb = pbs;
892 1.4 ad
893 1.4 ad pb[0] = STAMP_CMD_COPYSPANS | STAMP_LW_PERPACKET;
894 1.4 ad pb[1] = (num << 24) | 0xffffff;
895 1.4 ad pb[2] = 0x0;
896 1.4 ad pb[3] = STAMP_UPDATE_ENABLE | STAMP_METHOD_COPY | STAMP_SPAN |
897 1.4 ad STAMP_COPYSPAN_ALIGNED;
898 1.4 ad pb[4] = 1; /* linewidth */
899 1.4 ad
900 1.4 ad for (; num != 0; num--, src += inc, dst += inc, pb += 3) {
901 1.4 ad pb[5] = 1280 << 3;
902 1.4 ad pb[6] = src;
903 1.4 ad pb[7] = dst;
904 1.4 ad }
905 1.4 ad
906 1.4 ad (*si->si_pbuf_post)(si, pbs);
907 1.4 ad }
908 1.4 ad }
909 1.4 ad
910 1.4 ad static void
911 1.4 ad stic_copycols(void *cookie, int row, int src, int dst, int num)
912 1.4 ad {
913 1.4 ad struct stic_info *si;
914 1.4 ad struct stic_screen *ss;
915 1.4 ad u_int height, updword;
916 1.4 ad u_int32_t *pb, *pbs;
917 1.4 ad
918 1.4 ad ss = cookie;
919 1.4 ad si = ss->ss_si;
920 1.4 ad
921 1.4 ad if (ss->ss_backing != NULL)
922 1.4 ad bcopy(ss->ss_backing + row * si->si_consw + src,
923 1.4 ad ss->ss_backing + row * si->si_consw + dst,
924 1.4 ad num * sizeof(*ss->ss_backing));
925 1.4 ad if ((ss->ss_flags & SS_ACTIVE) == 0)
926 1.4 ad return;
927 1.4 ad
928 1.4 ad /*
929 1.4 ad * The stamp reads and writes left -> right only, so we need to
930 1.4 ad * buffer the span if the source and destination regions overlap
931 1.4 ad * and the source is left of the destination.
932 1.4 ad */
933 1.4 ad updword = STAMP_UPDATE_ENABLE | STAMP_METHOD_COPY | STAMP_SPAN;
934 1.4 ad
935 1.4 ad if (src < dst && src + num > dst)
936 1.4 ad updword |= STAMP_HALF_BUFF;
937 1.4 ad
938 1.4 ad row = (row * si->si_fonth) << 3;
939 1.4 ad num = (num * si->si_fontw) << 3;
940 1.4 ad src = row | ((src * si->si_fontw) << 19);
941 1.4 ad dst = row | ((dst * si->si_fontw) << 19);
942 1.4 ad height = si->si_fonth;
943 1.4 ad
944 1.4 ad pbs = (*si->si_pbuf_get)(si);
945 1.4 ad pb = pbs;
946 1.4 ad
947 1.4 ad pb[0] = STAMP_CMD_COPYSPANS | STAMP_LW_PERPACKET;
948 1.4 ad pb[1] = (height << 24) | 0xffffff;
949 1.4 ad pb[2] = 0x0;
950 1.4 ad pb[3] = updword;
951 1.4 ad pb[4] = 1; /* linewidth */
952 1.4 ad
953 1.4 ad for ( ; height != 0; height--, src += 8, dst += 8, pb += 3) {
954 1.4 ad pb[5] = num;
955 1.4 ad pb[6] = src;
956 1.4 ad pb[7] = dst;
957 1.4 ad }
958 1.4 ad
959 1.4 ad (*si->si_pbuf_post)(si, pbs);
960 1.4 ad }
961 1.4 ad
962 1.4 ad static void
963 1.4 ad stic_putchar(void *cookie, int r, int c, u_int uc, long attr)
964 1.4 ad {
965 1.4 ad struct wsdisplay_font *font;
966 1.4 ad struct stic_screen *ss;
967 1.4 ad struct stic_info *si;
968 1.4 ad u_int i, bgcolor, fgcolor;
969 1.4 ad u_int *pb, v1, v2, xya;
970 1.4 ad u_short *fr;
971 1.4 ad
972 1.4 ad ss = cookie;
973 1.4 ad si = ss->ss_si;
974 1.4 ad
975 1.4 ad /* It's cheaper to use erasecols() to blit blanks. */
976 1.4 ad if (uc == 0) {
977 1.4 ad stic_erasecols(cookie, r, c, 1, attr);
978 1.4 ad return;
979 1.4 ad }
980 1.4 ad
981 1.4 ad if (ss->ss_backing != NULL)
982 1.4 ad ss->ss_backing[r * si->si_consw + c] =
983 1.4 ad (u_int16_t)((attr & 0xff) | (uc << 8));
984 1.4 ad if ((ss->ss_flags & SS_ACTIVE) == 0)
985 1.4 ad return;
986 1.4 ad
987 1.4 ad font = si->si_font;
988 1.4 ad pb = (*si->si_pbuf_get)(si);
989 1.4 ad
990 1.4 ad /*
991 1.4 ad * Create a mask from the glyph. Squeeze the foreground color
992 1.4 ad * through the mask, and then squeeze the background color through
993 1.4 ad * the inverted mask. We may well read outside the glyph when
994 1.4 ad * creating the mask, but it's bounded by the hardware so it
995 1.4 ad * shouldn't matter a great deal...
996 1.4 ad */
997 1.4 ad pb[0] = STAMP_CMD_LINES | STAMP_RGB_FLAT | STAMP_XY_PERPRIMATIVE |
998 1.4 ad STAMP_LW_PERPRIMATIVE;
999 1.4 ad pb[1] = font->fontheight > 16 ? 0x04ffffff : 0x02ffffff;
1000 1.4 ad pb[2] = 0x0;
1001 1.4 ad pb[3] = STAMP_UPDATE_ENABLE | STAMP_WE_XYMASK | STAMP_METHOD_COPY;
1002 1.4 ad
1003 1.4 ad r *= font->fontheight;
1004 1.4 ad c *= font->fontwidth;
1005 1.4 ad uc = (uc - font->firstchar) * font->stride * font->fontheight;
1006 1.4 ad fr = (u_short *)((caddr_t)font->data + uc);
1007 1.6 ad bgcolor = DUPBYTE1((attr & 0xf0) >> 4);
1008 1.4 ad fgcolor = DUPBYTE0(attr & 0x0f);
1009 1.4 ad
1010 1.4 ad i = ((font->fontheight > 16 ? 16 : font->fontheight) << 2) - 1;
1011 1.4 ad v1 = (c << 19) | ((r << 3) + i);
1012 1.4 ad v2 = ((c + font->fontwidth) << 19) | (v1 & 0xffff);
1013 1.4 ad xya = XYMASKADDR(si->si_stampw, si->si_stamph, c, r, 0, 0);
1014 1.4 ad
1015 1.4 ad pb[4] = PACK(fr, 0);
1016 1.4 ad pb[5] = PACK(fr, 2);
1017 1.4 ad pb[6] = PACK(fr, 4);
1018 1.4 ad pb[7] = PACK(fr, 6);
1019 1.4 ad pb[8] = PACK(fr, 8);
1020 1.4 ad pb[9] = PACK(fr, 10);
1021 1.4 ad pb[10] = PACK(fr, 12);
1022 1.4 ad pb[11] = PACK(fr, 14);
1023 1.4 ad pb[12] = xya;
1024 1.4 ad pb[13] = v1;
1025 1.4 ad pb[14] = v2;
1026 1.4 ad pb[15] = i;
1027 1.4 ad pb[16] = fgcolor;
1028 1.4 ad
1029 1.4 ad pb[17] = ~pb[4];
1030 1.4 ad pb[18] = ~pb[5];
1031 1.4 ad pb[19] = ~pb[6];
1032 1.4 ad pb[20] = ~pb[7];
1033 1.4 ad pb[21] = ~pb[8];
1034 1.4 ad pb[22] = ~pb[9];
1035 1.4 ad pb[23] = ~pb[10];
1036 1.4 ad pb[24] = ~pb[11];
1037 1.4 ad pb[25] = xya;
1038 1.4 ad pb[26] = v1;
1039 1.4 ad pb[27] = v2;
1040 1.4 ad pb[28] = i;
1041 1.4 ad pb[29] = bgcolor;
1042 1.4 ad
1043 1.4 ad /* Two more squeezes for the lower part of the character. */
1044 1.4 ad if (font->fontheight > 16) {
1045 1.4 ad i = ((font->fontheight - 16) << 2) - 1;
1046 1.4 ad r += 16;
1047 1.4 ad v1 = (c << 19) | ((r << 3) + i);
1048 1.4 ad v2 = ((c + font->fontwidth) << 19) | (v1 & 0xffff);
1049 1.4 ad
1050 1.4 ad pb[30] = PACK(fr, 16);
1051 1.4 ad pb[31] = PACK(fr, 18);
1052 1.4 ad pb[32] = PACK(fr, 20);
1053 1.4 ad pb[33] = PACK(fr, 22);
1054 1.4 ad pb[34] = PACK(fr, 24);
1055 1.4 ad pb[35] = PACK(fr, 26);
1056 1.4 ad pb[36] = PACK(fr, 28);
1057 1.4 ad pb[37] = PACK(fr, 30);
1058 1.4 ad pb[38] = xya;
1059 1.4 ad pb[39] = v1;
1060 1.4 ad pb[40] = v2;
1061 1.4 ad pb[41] = i;
1062 1.4 ad pb[42] = fgcolor;
1063 1.4 ad
1064 1.4 ad pb[43] = ~pb[30];
1065 1.4 ad pb[44] = ~pb[31];
1066 1.4 ad pb[45] = ~pb[32];
1067 1.4 ad pb[46] = ~pb[33];
1068 1.4 ad pb[47] = ~pb[34];
1069 1.4 ad pb[48] = ~pb[35];
1070 1.4 ad pb[49] = ~pb[36];
1071 1.4 ad pb[50] = ~pb[37];
1072 1.4 ad pb[51] = xya;
1073 1.4 ad pb[52] = v1;
1074 1.4 ad pb[53] = v2;
1075 1.4 ad pb[54] = i;
1076 1.4 ad pb[55] = bgcolor;
1077 1.4 ad }
1078 1.4 ad
1079 1.4 ad (*si->si_pbuf_post)(si, pb);
1080 1.4 ad }
1081 1.4 ad
1082 1.4 ad static int
1083 1.4 ad stic_mapchar(void *cookie, int c, u_int *cp)
1084 1.4 ad {
1085 1.4 ad struct stic_info *si;
1086 1.4 ad
1087 1.4 ad si = ((struct stic_screen *)cookie)->ss_si;
1088 1.4 ad
1089 1.4 ad if (c < si->si_font->firstchar || c == ' ') {
1090 1.4 ad *cp = 0;
1091 1.4 ad return (0);
1092 1.4 ad }
1093 1.4 ad
1094 1.4 ad if (c - si->si_font->firstchar >= si->si_font->numchars) {
1095 1.4 ad *cp = 0;
1096 1.4 ad return (0);
1097 1.4 ad }
1098 1.4 ad
1099 1.4 ad *cp = c;
1100 1.4 ad return (5);
1101 1.4 ad }
1102 1.4 ad
1103 1.4 ad static void
1104 1.4 ad stic_cursor(void *cookie, int on, int row, int col)
1105 1.4 ad {
1106 1.4 ad struct stic_screen *ss;
1107 1.7 ad struct stic_info *si;
1108 1.4 ad
1109 1.4 ad ss = cookie;
1110 1.7 ad si = ss->ss_si;
1111 1.4 ad
1112 1.7 ad ss->ss_curx = col * si->si_fontw;
1113 1.7 ad ss->ss_cury = row * si->si_fonth;
1114 1.7 ad
1115 1.7 ad if ((ss->ss_flags & SS_ACTIVE) != 0) {
1116 1.7 ad /* XXX We should do cursor on/off. */
1117 1.7 ad si->si_cursor.cc_pos.x = ss->ss_curx;
1118 1.7 ad si->si_cursor.cc_pos.y = ss->ss_cury;
1119 1.7 ad stic_set_hwcurpos(si);
1120 1.7 ad }
1121 1.4 ad }
1122 1.4 ad
1123 1.4 ad void
1124 1.4 ad stic_flush(struct stic_info *si)
1125 1.4 ad {
1126 1.4 ad volatile u_int32_t *vdac;
1127 1.4 ad int v;
1128 1.4 ad
1129 1.7 ad if ((si->si_flags & SI_ALL_CHANGED) == 0)
1130 1.4 ad return;
1131 1.4 ad
1132 1.4 ad vdac = si->si_vdac;
1133 1.7 ad v = si->si_flags;
1134 1.7 ad si->si_flags &= ~SI_ALL_CHANGED;
1135 1.4 ad
1136 1.7 ad if ((v & SI_CURENB_CHANGED) != 0) {
1137 1.4 ad SELECT(vdac, BT459_IREG_CCR);
1138 1.7 ad if ((v & SI_CURENB) != 0)
1139 1.7 ad REG(vdac, bt_reg) = 0x00c0c0c0;
1140 1.7 ad else
1141 1.4 ad REG(vdac, bt_reg) = 0x00000000;
1142 1.4 ad tc_wmb();
1143 1.4 ad }
1144 1.1 jonathan
1145 1.7 ad if ((v & SI_CURCMAP_CHANGED) != 0) {
1146 1.4 ad u_int8_t *cp;
1147 1.7 ad
1148 1.7 ad cp = si->si_cursor.cc_color;
1149 1.4 ad
1150 1.4 ad SELECT(vdac, BT459_IREG_CCOLOR_2);
1151 1.7 ad REG(vdac, bt_reg) = DUPBYTE0(cp[1]); tc_wmb();
1152 1.7 ad REG(vdac, bt_reg) = DUPBYTE0(cp[3]); tc_wmb();
1153 1.7 ad REG(vdac, bt_reg) = DUPBYTE0(cp[5]); tc_wmb();
1154 1.7 ad REG(vdac, bt_reg) = DUPBYTE0(cp[0]); tc_wmb();
1155 1.7 ad REG(vdac, bt_reg) = DUPBYTE0(cp[2]); tc_wmb();
1156 1.7 ad REG(vdac, bt_reg) = DUPBYTE0(cp[4]); tc_wmb();
1157 1.4 ad }
1158 1.1 jonathan
1159 1.7 ad if ((v & SI_CURSHAPE_CHANGED) != 0) {
1160 1.4 ad u_int8_t *ip, *mp, img, msk;
1161 1.4 ad u_int8_t u;
1162 1.4 ad int bcnt;
1163 1.4 ad
1164 1.7 ad ip = (u_int8_t *)si->si_cursor.cc_image;
1165 1.7 ad mp = (u_int8_t *)(si->si_cursor.cc_image + CURSOR_MAX_SIZE);
1166 1.4 ad
1167 1.4 ad bcnt = 0;
1168 1.4 ad SELECT(vdac, BT459_IREG_CRAM_BASE+0);
1169 1.4 ad /* 64 pixel scan line is consisted with 16 byte cursor ram */
1170 1.7 ad while (bcnt < si->si_cursor.cc_size.y * 16) {
1171 1.4 ad /* pad right half 32 pixel when smaller than 33 */
1172 1.7 ad if ((bcnt & 0x8) && si->si_cursor.cc_size.x < 33) {
1173 1.4 ad REG(vdac, bt_reg) = 0; tc_wmb();
1174 1.4 ad REG(vdac, bt_reg) = 0; tc_wmb();
1175 1.4 ad } else {
1176 1.4 ad img = *ip++;
1177 1.4 ad msk = *mp++;
1178 1.4 ad img &= msk; /* cookie off image */
1179 1.4 ad u = (msk & 0x0f) << 4 | (img & 0x0f);
1180 1.4 ad REG(vdac, bt_reg) = DUPBYTE0(shuffle[u]);
1181 1.4 ad tc_wmb();
1182 1.4 ad u = (msk & 0xf0) | (img & 0xf0) >> 4;
1183 1.4 ad REG(vdac, bt_reg) = DUPBYTE0(shuffle[u]);
1184 1.4 ad tc_wmb();
1185 1.4 ad }
1186 1.4 ad bcnt += 2;
1187 1.4 ad }
1188 1.4 ad /* pad unoccupied scan lines */
1189 1.4 ad while (bcnt < CURSOR_MAX_SIZE * 16) {
1190 1.4 ad REG(vdac, bt_reg) = 0; tc_wmb();
1191 1.4 ad REG(vdac, bt_reg) = 0; tc_wmb();
1192 1.4 ad bcnt += 2;
1193 1.4 ad }
1194 1.4 ad }
1195 1.4 ad
1196 1.7 ad if ((v & SI_CMAP_CHANGED) != 0) {
1197 1.4 ad struct stic_hwcmap256 *cm;
1198 1.4 ad int index;
1199 1.4 ad
1200 1.7 ad cm = &si->si_cmap;
1201 1.4 ad
1202 1.4 ad SELECT(vdac, 0);
1203 1.4 ad SELECT(vdac, 0);
1204 1.7 ad for (index = 0; index < CMAP_SIZE; index++) {
1205 1.7 ad REG(vdac, bt_cmap) = DUPBYTE0(cm->r[index]);
1206 1.7 ad tc_wmb();
1207 1.7 ad REG(vdac, bt_cmap) = DUPBYTE0(cm->g[index]);
1208 1.7 ad tc_wmb();
1209 1.7 ad REG(vdac, bt_cmap) = DUPBYTE0(cm->b[index]);
1210 1.7 ad tc_wmb();
1211 1.1 jonathan }
1212 1.1 jonathan }
1213 1.4 ad }
1214 1.4 ad
1215 1.4 ad static int
1216 1.7 ad stic_get_cmap(struct stic_info *si, struct wsdisplay_cmap *p)
1217 1.4 ad {
1218 1.4 ad u_int index, count;
1219 1.4 ad
1220 1.4 ad index = p->index;
1221 1.4 ad count = p->count;
1222 1.4 ad
1223 1.4 ad if (index >= CMAP_SIZE || (index + count) > CMAP_SIZE)
1224 1.4 ad return (EINVAL);
1225 1.4 ad
1226 1.4 ad if (!uvm_useracc(p->red, count, B_WRITE) ||
1227 1.4 ad !uvm_useracc(p->green, count, B_WRITE) ||
1228 1.4 ad !uvm_useracc(p->blue, count, B_WRITE))
1229 1.4 ad return (EFAULT);
1230 1.4 ad
1231 1.7 ad copyout(&si->si_cmap.r[index], p->red, count);
1232 1.7 ad copyout(&si->si_cmap.g[index], p->green, count);
1233 1.7 ad copyout(&si->si_cmap.b[index], p->blue, count);
1234 1.4 ad return (0);
1235 1.4 ad }
1236 1.4 ad
1237 1.4 ad static int
1238 1.7 ad stic_set_cmap(struct stic_info *si, struct wsdisplay_cmap *p)
1239 1.4 ad {
1240 1.4 ad u_int index, count;
1241 1.4 ad
1242 1.4 ad index = p->index;
1243 1.4 ad count = p->count;
1244 1.4 ad
1245 1.7 ad if ((index + count) > CMAP_SIZE)
1246 1.4 ad return (EINVAL);
1247 1.4 ad
1248 1.4 ad if (!uvm_useracc(p->red, count, B_READ) ||
1249 1.4 ad !uvm_useracc(p->green, count, B_READ) ||
1250 1.4 ad !uvm_useracc(p->blue, count, B_READ))
1251 1.4 ad return (EFAULT);
1252 1.4 ad
1253 1.7 ad copyin(p->red, &si->si_cmap.r[index], count);
1254 1.7 ad copyin(p->green, &si->si_cmap.g[index], count);
1255 1.7 ad copyin(p->blue, &si->si_cmap.b[index], count);
1256 1.4 ad
1257 1.7 ad si->si_flags |= SI_CMAP_CHANGED;
1258 1.4 ad
1259 1.4 ad /*
1260 1.4 ad * XXX Since we don't yet receive vblank interrupts from the PXG, we
1261 1.4 ad * must flush immediatley.
1262 1.4 ad */
1263 1.7 ad if (si->si_disptype == WSDISPLAY_TYPE_PXG)
1264 1.7 ad stic_flush(si);
1265 1.4 ad
1266 1.4 ad return (0);
1267 1.4 ad }
1268 1.4 ad
1269 1.4 ad static int
1270 1.7 ad stic_set_cursor(struct stic_info *si, struct wsdisplay_cursor *p)
1271 1.4 ad {
1272 1.7 ad #define cc (&si->si_cursor)
1273 1.4 ad int v, index, count, icount;
1274 1.4 ad
1275 1.4 ad v = p->which;
1276 1.4 ad
1277 1.4 ad if ((v & WSDISPLAY_CURSOR_DOCMAP) != 0) {
1278 1.4 ad index = p->cmap.index;
1279 1.4 ad count = p->cmap.count;
1280 1.4 ad if (index >= 2 || (index + count) > 2)
1281 1.4 ad return (EINVAL);
1282 1.4 ad if (!uvm_useracc(p->cmap.red, count, B_READ) ||
1283 1.4 ad !uvm_useracc(p->cmap.green, count, B_READ) ||
1284 1.4 ad !uvm_useracc(p->cmap.blue, count, B_READ))
1285 1.4 ad return (EFAULT);
1286 1.4 ad }
1287 1.4 ad
1288 1.4 ad if ((v & WSDISPLAY_CURSOR_DOSHAPE) != 0) {
1289 1.4 ad if (p->size.x > CURSOR_MAX_SIZE || p->size.y > CURSOR_MAX_SIZE)
1290 1.4 ad return (EINVAL);
1291 1.4 ad icount = ((p->size.x < 33) ? 4 : 8) * p->size.y;
1292 1.4 ad if (!uvm_useracc(p->image, icount, B_READ) ||
1293 1.4 ad !uvm_useracc(p->mask, icount, B_READ))
1294 1.4 ad return (EFAULT);
1295 1.4 ad }
1296 1.4 ad
1297 1.4 ad if ((v & (WSDISPLAY_CURSOR_DOPOS | WSDISPLAY_CURSOR_DOCUR)) != 0) {
1298 1.4 ad if (v & WSDISPLAY_CURSOR_DOCUR)
1299 1.4 ad cc->cc_hot = p->hot;
1300 1.4 ad if (v & WSDISPLAY_CURSOR_DOPOS)
1301 1.7 ad stic_set_curpos(si, &p->pos);
1302 1.4 ad }
1303 1.4 ad
1304 1.4 ad if ((v & WSDISPLAY_CURSOR_DOCUR) != 0) {
1305 1.4 ad if (p->enable)
1306 1.7 ad si->si_flags |= SI_CURENB;
1307 1.4 ad else
1308 1.7 ad si->si_flags &= ~SI_CURENB;
1309 1.7 ad si->si_flags |= SI_CURENB_CHANGED;
1310 1.4 ad }
1311 1.4 ad
1312 1.4 ad if ((v & WSDISPLAY_CURSOR_DOCMAP) != 0) {
1313 1.4 ad copyin(p->cmap.red, &cc->cc_color[index], count);
1314 1.4 ad copyin(p->cmap.green, &cc->cc_color[index + 2], count);
1315 1.4 ad copyin(p->cmap.blue, &cc->cc_color[index + 4], count);
1316 1.7 ad si->si_flags |= SI_CURCMAP_CHANGED;
1317 1.4 ad }
1318 1.1 jonathan
1319 1.4 ad if ((v & WSDISPLAY_CURSOR_DOSHAPE) != 0) {
1320 1.4 ad cc->cc_size = p->size;
1321 1.4 ad memset(cc->cc_image, 0, sizeof cc->cc_image);
1322 1.4 ad copyin(p->image, cc->cc_image, icount);
1323 1.4 ad copyin(p->mask, cc->cc_image+CURSOR_MAX_SIZE, icount);
1324 1.7 ad si->si_flags |= SI_CURSHAPE_CHANGED;
1325 1.4 ad }
1326 1.4 ad
1327 1.4 ad /*
1328 1.4 ad * XXX Since we don't yet receive vblank interrupts from the PXG, we
1329 1.4 ad * must flush immediatley.
1330 1.4 ad */
1331 1.7 ad if (si->si_disptype == WSDISPLAY_TYPE_PXG)
1332 1.7 ad stic_flush(si);
1333 1.4 ad
1334 1.4 ad return (0);
1335 1.4 ad #undef cc
1336 1.4 ad }
1337 1.4 ad
1338 1.4 ad static int
1339 1.7 ad stic_get_cursor(struct stic_info *si, struct wsdisplay_cursor *p)
1340 1.4 ad {
1341 1.4 ad
1342 1.7 ad /* XXX */
1343 1.4 ad return (ENOTTY);
1344 1.4 ad }
1345 1.4 ad
1346 1.4 ad static void
1347 1.7 ad stic_set_curpos(struct stic_info *si, struct wsdisplay_curpos *curpos)
1348 1.4 ad {
1349 1.4 ad int x, y;
1350 1.4 ad
1351 1.4 ad x = curpos->x;
1352 1.4 ad y = curpos->y;
1353 1.4 ad
1354 1.4 ad if (y < 0)
1355 1.4 ad y = 0;
1356 1.4 ad else if (y > 1023)
1357 1.4 ad y = 1023;
1358 1.4 ad if (x < 0)
1359 1.4 ad x = 0;
1360 1.4 ad else if (x > 1279)
1361 1.4 ad x = 1279;
1362 1.4 ad
1363 1.7 ad si->si_cursor.cc_pos.x = x;
1364 1.7 ad si->si_cursor.cc_pos.y = y;
1365 1.7 ad stic_set_hwcurpos(si);
1366 1.4 ad }
1367 1.4 ad
1368 1.4 ad static void
1369 1.7 ad stic_set_hwcurpos(struct stic_info *si)
1370 1.4 ad {
1371 1.4 ad volatile u_int32_t *vdac;
1372 1.4 ad int x, y, s;
1373 1.4 ad
1374 1.4 ad vdac = si->si_vdac;
1375 1.4 ad
1376 1.7 ad x = si->si_cursor.cc_pos.x - si->si_cursor.cc_hot.x;
1377 1.7 ad y = si->si_cursor.cc_pos.y - si->si_cursor.cc_hot.y;
1378 1.4 ad x += STIC_MAGIC_X;
1379 1.4 ad y += STIC_MAGIC_Y;
1380 1.4 ad
1381 1.4 ad s = spltty();
1382 1.4 ad SELECT(vdac, BT459_IREG_CURSOR_X_LOW);
1383 1.4 ad REG(vdac, bt_reg) = DUPBYTE0(x); tc_wmb();
1384 1.4 ad REG(vdac, bt_reg) = DUPBYTE1(x); tc_wmb();
1385 1.4 ad REG(vdac, bt_reg) = DUPBYTE0(y); tc_wmb();
1386 1.4 ad REG(vdac, bt_reg) = DUPBYTE1(y); tc_wmb();
1387 1.4 ad splx(s);
1388 1.1 jonathan }
1389