cfb.c revision 1.13 1 1.13 nisimura /* $NetBSD: cfb.c,v 1.13 1999/10/19 00:49:34 nisimura Exp $ */
2 1.2 nisimura
3 1.2 nisimura /*
4 1.12 nisimura * Copyright (c) 1998, 1999 Tohru Nishimura. All rights reserved.
5 1.2 nisimura *
6 1.2 nisimura * Redistribution and use in source and binary forms, with or without
7 1.2 nisimura * modification, are permitted provided that the following conditions
8 1.2 nisimura * are met:
9 1.2 nisimura * 1. Redistributions of source code must retain the above copyright
10 1.2 nisimura * notice, this list of conditions and the following disclaimer.
11 1.2 nisimura * 2. Redistributions in binary form must reproduce the above copyright
12 1.2 nisimura * notice, this list of conditions and the following disclaimer in the
13 1.2 nisimura * documentation and/or other materials provided with the distribution.
14 1.2 nisimura * 3. All advertising materials mentioning features or use of this software
15 1.2 nisimura * must display the following acknowledgement:
16 1.2 nisimura * This product includes software developed by Tohru Nishimura
17 1.2 nisimura * for the NetBSD Project.
18 1.2 nisimura * 4. The name of the author may not be used to endorse or promote products
19 1.2 nisimura * derived from this software without specific prior written permission
20 1.2 nisimura *
21 1.2 nisimura * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
22 1.2 nisimura * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
23 1.2 nisimura * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
24 1.2 nisimura * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
25 1.2 nisimura * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
26 1.2 nisimura * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
27 1.2 nisimura * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
28 1.2 nisimura * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
29 1.2 nisimura * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
30 1.2 nisimura * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
31 1.2 nisimura */
32 1.1 nisimura
33 1.1 nisimura #include <sys/cdefs.h> /* RCS ID & Copyright macro defns */
34 1.1 nisimura
35 1.13 nisimura __KERNEL_RCSID(0, "$NetBSD: cfb.c,v 1.13 1999/10/19 00:49:34 nisimura Exp $");
36 1.1 nisimura
37 1.1 nisimura #include <sys/param.h>
38 1.1 nisimura #include <sys/systm.h>
39 1.1 nisimura #include <sys/kernel.h>
40 1.1 nisimura #include <sys/device.h>
41 1.1 nisimura #include <sys/malloc.h>
42 1.1 nisimura #include <sys/buf.h>
43 1.1 nisimura #include <sys/ioctl.h>
44 1.1 nisimura #include <vm/vm.h>
45 1.1 nisimura
46 1.1 nisimura #include <machine/bus.h>
47 1.1 nisimura #include <machine/intr.h>
48 1.1 nisimura
49 1.1 nisimura #include <dev/rcons/raster.h>
50 1.1 nisimura #include <dev/wscons/wsconsio.h>
51 1.1 nisimura #include <dev/wscons/wscons_raster.h>
52 1.1 nisimura #include <dev/wscons/wsdisplayvar.h>
53 1.1 nisimura
54 1.1 nisimura #include <dev/tc/tcvar.h>
55 1.1 nisimura #include <dev/ic/bt459reg.h>
56 1.1 nisimura
57 1.1 nisimura #include <uvm/uvm_extern.h>
58 1.1 nisimura
59 1.7 thorpej #if defined(pmax)
60 1.1 nisimura #define machine_btop(x) mips_btop(x)
61 1.1 nisimura #define MACHINE_KSEG0_TO_PHYS(x) MIPS_KSEG1_TO_PHYS(x)
62 1.1 nisimura #endif
63 1.1 nisimura
64 1.1 nisimura #if defined(__alpha__) || defined(alpha)
65 1.1 nisimura /*
66 1.1 nisimura * Digital UNIX never supports PMAG-BA
67 1.1 nisimura */
68 1.1 nisimura #define machine_btop(x) alpha_btop(x)
69 1.1 nisimura #define MACHINE_KSEG0_TO_PHYS(x) ALPHA_K0SEG_TO_PHYS(x)
70 1.1 nisimura #endif
71 1.1 nisimura
72 1.1 nisimura /*
73 1.1 nisimura * N.B., Bt459 registers are 8bit width. Some of TC framebuffers have
74 1.3 nisimura * obscure register layout such as 2nd and 3rd Bt459 registers are
75 1.3 nisimura * adjacent each other in a word, i.e.,
76 1.1 nisimura * struct bt459triplet {
77 1.1 nisimura * struct {
78 1.1 nisimura * u_int8_t u0;
79 1.1 nisimura * u_int8_t u1;
80 1.1 nisimura * u_int8_t u2;
81 1.1 nisimura * unsigned :8;
82 1.1 nisimura * } bt_lo;
83 1.1 nisimura * ...
84 1.1 nisimura * Although CX has single Bt459, 32bit R/W can be done w/o any trouble.
85 1.12 nisimura *
86 1.12 nisimura * struct bt459reg {
87 1.12 nisimura * u_int32_t bt_lo;
88 1.12 nisimura * u_int32_t bt_hi;
89 1.12 nisimura * u_int32_t bt_reg;
90 1.12 nisimura * u_int32_t bt_cmap;
91 1.12 nisimura * };
92 1.12 nisimura *
93 1.1 nisimura */
94 1.2 nisimura
95 1.12 nisimura /* Bt459 hardware registers */
96 1.12 nisimura #define bt_lo 0
97 1.12 nisimura #define bt_hi 1
98 1.12 nisimura #define bt_reg 2
99 1.12 nisimura #define bt_cmap 3
100 1.12 nisimura
101 1.12 nisimura #define REG(base, index) *((u_int32_t *)(base) + (index))
102 1.12 nisimura #define SELECT(vdac, regno) do { \
103 1.12 nisimura REG(vdac, bt_lo) = ((regno) & 0x00ff); \
104 1.12 nisimura REG(vdac, bt_hi) = ((regno) & 0x0f00) >> 8; \
105 1.12 nisimura tc_wmb(); \
106 1.12 nisimura } while (0)
107 1.1 nisimura
108 1.1 nisimura struct fb_devconfig {
109 1.1 nisimura vaddr_t dc_vaddr; /* memory space virtual base address */
110 1.1 nisimura paddr_t dc_paddr; /* memory space physical base address */
111 1.1 nisimura vsize_t dc_size; /* size of slot memory */
112 1.1 nisimura int dc_wid; /* width of frame buffer */
113 1.1 nisimura int dc_ht; /* height of frame buffer */
114 1.1 nisimura int dc_depth; /* depth, bits per pixel */
115 1.1 nisimura int dc_rowbytes; /* bytes in a FB scan line */
116 1.1 nisimura vaddr_t dc_videobase; /* base of flat frame buffer */
117 1.1 nisimura struct raster dc_raster; /* raster description */
118 1.1 nisimura struct rcons dc_rcons; /* raster blitter control info */
119 1.1 nisimura int dc_blanked; /* currently has video disabled */
120 1.1 nisimura };
121 1.1 nisimura
122 1.11 nisimura struct hwcmap256 {
123 1.1 nisimura #define CMAP_SIZE 256 /* 256 R/G/B entries */
124 1.1 nisimura u_int8_t r[CMAP_SIZE];
125 1.1 nisimura u_int8_t g[CMAP_SIZE];
126 1.1 nisimura u_int8_t b[CMAP_SIZE];
127 1.1 nisimura };
128 1.1 nisimura
129 1.11 nisimura struct hwcursor64 {
130 1.1 nisimura struct wsdisplay_curpos cc_pos;
131 1.1 nisimura struct wsdisplay_curpos cc_hot;
132 1.1 nisimura struct wsdisplay_curpos cc_size;
133 1.11 nisimura struct wsdisplay_curpos cc_magic;
134 1.1 nisimura #define CURSOR_MAX_SIZE 64
135 1.1 nisimura u_int8_t cc_color[6];
136 1.1 nisimura u_int64_t cc_image[64 + 64];
137 1.1 nisimura };
138 1.1 nisimura
139 1.1 nisimura struct cfb_softc {
140 1.1 nisimura struct device sc_dev;
141 1.1 nisimura struct fb_devconfig *sc_dc; /* device configuration */
142 1.11 nisimura struct hwcmap256 sc_cmap; /* software copy of colormap */
143 1.11 nisimura struct hwcursor64 sc_cursor; /* software copy of cursor */
144 1.1 nisimura int sc_curenb; /* cursor sprite enabled */
145 1.1 nisimura int sc_changed; /* need update of colormap */
146 1.1 nisimura #define DATA_ENB_CHANGED 0x01 /* cursor enable changed */
147 1.1 nisimura #define DATA_CURCMAP_CHANGED 0x02 /* cursor colormap changed */
148 1.1 nisimura #define DATA_CURSHAPE_CHANGED 0x04 /* cursor size, image, mask changed */
149 1.1 nisimura #define DATA_CMAP_CHANGED 0x08 /* colormap changed */
150 1.1 nisimura #define DATA_ALL_CHANGED 0x0f
151 1.1 nisimura int nscreens;
152 1.11 nisimura };
153 1.11 nisimura
154 1.12 nisimura #define CX_MAGIC_X 220
155 1.12 nisimura #define CX_MAGIC_Y 35
156 1.1 nisimura
157 1.3 nisimura #define CX_FB_OFFSET 0x000000
158 1.3 nisimura #define CX_FB_SIZE 0x100000
159 1.3 nisimura #define CX_BT459_OFFSET 0x200000
160 1.3 nisimura #define CX_OFFSET_IREQ 0x300000 /* Interrupt req. control */
161 1.3 nisimura
162 1.1 nisimura int cfbmatch __P((struct device *, struct cfdata *, void *));
163 1.1 nisimura void cfbattach __P((struct device *, struct device *, void *));
164 1.1 nisimura
165 1.1 nisimura struct cfattach cfb_ca = {
166 1.1 nisimura sizeof(struct cfb_softc), cfbmatch, cfbattach,
167 1.1 nisimura };
168 1.1 nisimura
169 1.1 nisimura void cfb_getdevconfig __P((tc_addr_t, struct fb_devconfig *));
170 1.1 nisimura struct fb_devconfig cfb_console_dc;
171 1.1 nisimura tc_addr_t cfb_consaddr;
172 1.1 nisimura
173 1.1 nisimura struct wsdisplay_emulops cfb_emulops = {
174 1.1 nisimura rcons_cursor, /* could use hardware cursor; punt */
175 1.1 nisimura rcons_mapchar,
176 1.1 nisimura rcons_putchar,
177 1.1 nisimura rcons_copycols,
178 1.1 nisimura rcons_erasecols,
179 1.1 nisimura rcons_copyrows,
180 1.1 nisimura rcons_eraserows,
181 1.1 nisimura rcons_alloc_attr
182 1.1 nisimura };
183 1.1 nisimura
184 1.1 nisimura struct wsscreen_descr cfb_stdscreen = {
185 1.1 nisimura "std", 0, 0,
186 1.1 nisimura &cfb_emulops,
187 1.1 nisimura 0, 0,
188 1.13 nisimura WSSCREEN_REVERSE
189 1.1 nisimura };
190 1.1 nisimura
191 1.1 nisimura const struct wsscreen_descr *_cfb_scrlist[] = {
192 1.1 nisimura &cfb_stdscreen,
193 1.1 nisimura };
194 1.1 nisimura
195 1.1 nisimura struct wsscreen_list cfb_screenlist = {
196 1.1 nisimura sizeof(_cfb_scrlist) / sizeof(struct wsscreen_descr *), _cfb_scrlist
197 1.1 nisimura };
198 1.1 nisimura
199 1.1 nisimura int cfbioctl __P((void *, u_long, caddr_t, int, struct proc *));
200 1.1 nisimura int cfbmmap __P((void *, off_t, int));
201 1.1 nisimura
202 1.1 nisimura int cfb_alloc_screen __P((void *, const struct wsscreen_descr *,
203 1.1 nisimura void **, int *, int *, long *));
204 1.1 nisimura void cfb_free_screen __P((void *, void *));
205 1.1 nisimura void cfb_show_screen __P((void *, void *));
206 1.1 nisimura
207 1.1 nisimura struct wsdisplay_accessops cfb_accessops = {
208 1.1 nisimura cfbioctl,
209 1.1 nisimura cfbmmap,
210 1.1 nisimura cfb_alloc_screen,
211 1.1 nisimura cfb_free_screen,
212 1.1 nisimura cfb_show_screen,
213 1.6 drochner 0 /* load_font */
214 1.1 nisimura };
215 1.1 nisimura
216 1.1 nisimura int cfb_cnattach __P((tc_addr_t));
217 1.1 nisimura int cfbintr __P((void *));
218 1.1 nisimura void cfbinit __P((struct fb_devconfig *));
219 1.1 nisimura
220 1.1 nisimura static int get_cmap __P((struct cfb_softc *, struct wsdisplay_cmap *));
221 1.1 nisimura static int set_cmap __P((struct cfb_softc *, struct wsdisplay_cmap *));
222 1.1 nisimura static int set_cursor __P((struct cfb_softc *, struct wsdisplay_cursor *));
223 1.1 nisimura static int get_cursor __P((struct cfb_softc *, struct wsdisplay_cursor *));
224 1.1 nisimura static void set_curpos __P((struct cfb_softc *, struct wsdisplay_curpos *));
225 1.1 nisimura static void bt459_set_curpos __P((struct cfb_softc *));
226 1.1 nisimura
227 1.3 nisimura /*
228 1.3 nisimura * Compose 2 bit/pixel cursor image. Bit order will be reversed.
229 1.3 nisimura * M M M M I I I I M I M I M I M I
230 1.3 nisimura * [ before ] [ after ]
231 1.3 nisimura * 3 2 1 0 3 2 1 0 0 0 1 1 2 2 3 3
232 1.3 nisimura * 7 6 5 4 7 6 5 4 4 4 5 5 6 6 7 7
233 1.3 nisimura */
234 1.3 nisimura const static u_int8_t shuffle[256] = {
235 1.3 nisimura 0x00, 0x40, 0x10, 0x50, 0x04, 0x44, 0x14, 0x54,
236 1.3 nisimura 0x01, 0x41, 0x11, 0x51, 0x05, 0x45, 0x15, 0x55,
237 1.3 nisimura 0x80, 0xc0, 0x90, 0xd0, 0x84, 0xc4, 0x94, 0xd4,
238 1.3 nisimura 0x81, 0xc1, 0x91, 0xd1, 0x85, 0xc5, 0x95, 0xd5,
239 1.3 nisimura 0x20, 0x60, 0x30, 0x70, 0x24, 0x64, 0x34, 0x74,
240 1.3 nisimura 0x21, 0x61, 0x31, 0x71, 0x25, 0x65, 0x35, 0x75,
241 1.3 nisimura 0xa0, 0xe0, 0xb0, 0xf0, 0xa4, 0xe4, 0xb4, 0xf4,
242 1.3 nisimura 0xa1, 0xe1, 0xb1, 0xf1, 0xa5, 0xe5, 0xb5, 0xf5,
243 1.3 nisimura 0x08, 0x48, 0x18, 0x58, 0x0c, 0x4c, 0x1c, 0x5c,
244 1.3 nisimura 0x09, 0x49, 0x19, 0x59, 0x0d, 0x4d, 0x1d, 0x5d,
245 1.3 nisimura 0x88, 0xc8, 0x98, 0xd8, 0x8c, 0xcc, 0x9c, 0xdc,
246 1.3 nisimura 0x89, 0xc9, 0x99, 0xd9, 0x8d, 0xcd, 0x9d, 0xdd,
247 1.3 nisimura 0x28, 0x68, 0x38, 0x78, 0x2c, 0x6c, 0x3c, 0x7c,
248 1.3 nisimura 0x29, 0x69, 0x39, 0x79, 0x2d, 0x6d, 0x3d, 0x7d,
249 1.3 nisimura 0xa8, 0xe8, 0xb8, 0xf8, 0xac, 0xec, 0xbc, 0xfc,
250 1.3 nisimura 0xa9, 0xe9, 0xb9, 0xf9, 0xad, 0xed, 0xbd, 0xfd,
251 1.3 nisimura 0x02, 0x42, 0x12, 0x52, 0x06, 0x46, 0x16, 0x56,
252 1.3 nisimura 0x03, 0x43, 0x13, 0x53, 0x07, 0x47, 0x17, 0x57,
253 1.3 nisimura 0x82, 0xc2, 0x92, 0xd2, 0x86, 0xc6, 0x96, 0xd6,
254 1.3 nisimura 0x83, 0xc3, 0x93, 0xd3, 0x87, 0xc7, 0x97, 0xd7,
255 1.3 nisimura 0x22, 0x62, 0x32, 0x72, 0x26, 0x66, 0x36, 0x76,
256 1.3 nisimura 0x23, 0x63, 0x33, 0x73, 0x27, 0x67, 0x37, 0x77,
257 1.3 nisimura 0xa2, 0xe2, 0xb2, 0xf2, 0xa6, 0xe6, 0xb6, 0xf6,
258 1.3 nisimura 0xa3, 0xe3, 0xb3, 0xf3, 0xa7, 0xe7, 0xb7, 0xf7,
259 1.3 nisimura 0x0a, 0x4a, 0x1a, 0x5a, 0x0e, 0x4e, 0x1e, 0x5e,
260 1.3 nisimura 0x0b, 0x4b, 0x1b, 0x5b, 0x0f, 0x4f, 0x1f, 0x5f,
261 1.3 nisimura 0x8a, 0xca, 0x9a, 0xda, 0x8e, 0xce, 0x9e, 0xde,
262 1.3 nisimura 0x8b, 0xcb, 0x9b, 0xdb, 0x8f, 0xcf, 0x9f, 0xdf,
263 1.3 nisimura 0x2a, 0x6a, 0x3a, 0x7a, 0x2e, 0x6e, 0x3e, 0x7e,
264 1.3 nisimura 0x2b, 0x6b, 0x3b, 0x7b, 0x2f, 0x6f, 0x3f, 0x7f,
265 1.3 nisimura 0xaa, 0xea, 0xba, 0xfa, 0xae, 0xee, 0xbe, 0xfe,
266 1.3 nisimura 0xab, 0xeb, 0xbb, 0xfb, 0xaf, 0xef, 0xbf, 0xff,
267 1.3 nisimura };
268 1.1 nisimura
269 1.1 nisimura int
270 1.1 nisimura cfbmatch(parent, match, aux)
271 1.1 nisimura struct device *parent;
272 1.1 nisimura struct cfdata *match;
273 1.1 nisimura void *aux;
274 1.1 nisimura {
275 1.1 nisimura struct tc_attach_args *ta = aux;
276 1.1 nisimura
277 1.1 nisimura if (strncmp("PMAG-BA ", ta->ta_modname, TC_ROM_LLEN) != 0)
278 1.1 nisimura return (0);
279 1.1 nisimura
280 1.1 nisimura return (1);
281 1.1 nisimura }
282 1.1 nisimura
283 1.1 nisimura void
284 1.1 nisimura cfb_getdevconfig(dense_addr, dc)
285 1.1 nisimura tc_addr_t dense_addr;
286 1.1 nisimura struct fb_devconfig *dc;
287 1.1 nisimura {
288 1.1 nisimura struct raster *rap;
289 1.1 nisimura struct rcons *rcp;
290 1.1 nisimura int i;
291 1.1 nisimura
292 1.1 nisimura dc->dc_vaddr = dense_addr;
293 1.3 nisimura dc->dc_paddr = MACHINE_KSEG0_TO_PHYS(dc->dc_vaddr + CX_FB_OFFSET);
294 1.1 nisimura
295 1.1 nisimura dc->dc_wid = 1024;
296 1.1 nisimura dc->dc_ht = 864;
297 1.1 nisimura dc->dc_depth = 8;
298 1.1 nisimura dc->dc_rowbytes = 1024;
299 1.3 nisimura dc->dc_videobase = dc->dc_vaddr + CX_FB_OFFSET;
300 1.1 nisimura dc->dc_blanked = 0;
301 1.1 nisimura
302 1.1 nisimura /* initialize colormap and cursor resource */
303 1.1 nisimura cfbinit(dc);
304 1.1 nisimura
305 1.1 nisimura /* clear the screen */
306 1.1 nisimura for (i = 0; i < dc->dc_ht * dc->dc_rowbytes; i += sizeof(u_int32_t))
307 1.1 nisimura *(u_int32_t *)(dc->dc_videobase + i) = 0x0;
308 1.1 nisimura
309 1.1 nisimura /* initialize the raster */
310 1.1 nisimura rap = &dc->dc_raster;
311 1.1 nisimura rap->width = dc->dc_wid;
312 1.1 nisimura rap->height = dc->dc_ht;
313 1.1 nisimura rap->depth = dc->dc_depth;
314 1.1 nisimura rap->linelongs = dc->dc_rowbytes / sizeof(u_int32_t);
315 1.1 nisimura rap->pixels = (u_int32_t *)dc->dc_videobase;
316 1.1 nisimura
317 1.1 nisimura /* initialize the raster console blitter */
318 1.1 nisimura rcp = &dc->dc_rcons;
319 1.1 nisimura rcp->rc_sp = rap;
320 1.1 nisimura rcp->rc_crow = rcp->rc_ccol = -1;
321 1.1 nisimura rcp->rc_crowp = &rcp->rc_crow;
322 1.1 nisimura rcp->rc_ccolp = &rcp->rc_ccol;
323 1.1 nisimura rcons_init(rcp, 34, 80);
324 1.1 nisimura
325 1.1 nisimura cfb_stdscreen.nrows = dc->dc_rcons.rc_maxrow;
326 1.1 nisimura cfb_stdscreen.ncols = dc->dc_rcons.rc_maxcol;
327 1.1 nisimura }
328 1.1 nisimura
329 1.1 nisimura void
330 1.1 nisimura cfbattach(parent, self, aux)
331 1.1 nisimura struct device *parent, *self;
332 1.1 nisimura void *aux;
333 1.1 nisimura {
334 1.1 nisimura struct cfb_softc *sc = (struct cfb_softc *)self;
335 1.1 nisimura struct tc_attach_args *ta = aux;
336 1.1 nisimura struct wsemuldisplaydev_attach_args waa;
337 1.11 nisimura struct hwcmap256 *cm;
338 1.11 nisimura int console;
339 1.1 nisimura
340 1.1 nisimura console = (ta->ta_addr == cfb_consaddr);
341 1.1 nisimura if (console) {
342 1.1 nisimura sc->sc_dc = &cfb_console_dc;
343 1.1 nisimura sc->nscreens = 1;
344 1.1 nisimura }
345 1.1 nisimura else {
346 1.1 nisimura sc->sc_dc = (struct fb_devconfig *)
347 1.1 nisimura malloc(sizeof(struct fb_devconfig), M_DEVBUF, M_WAITOK);
348 1.1 nisimura cfb_getdevconfig(ta->ta_addr, sc->sc_dc);
349 1.1 nisimura }
350 1.1 nisimura printf(": %d x %d, %dbpp\n", sc->sc_dc->dc_wid, sc->sc_dc->dc_ht,
351 1.1 nisimura sc->sc_dc->dc_depth);
352 1.1 nisimura
353 1.1 nisimura cm = &sc->sc_cmap;
354 1.11 nisimura memset(cm, 255, sizeof(struct hwcmap256)); /* XXX */
355 1.11 nisimura cm->r[0] = cm->g[0] = cm->b[0] = 0; /* XXX */
356 1.11 nisimura
357 1.11 nisimura sc->sc_cursor.cc_magic.x = CX_MAGIC_X;
358 1.11 nisimura sc->sc_cursor.cc_magic.y = CX_MAGIC_Y;
359 1.1 nisimura
360 1.1 nisimura /* Establish an interrupt handler, and clear any pending interrupts */
361 1.12 nisimura tc_intr_establish(parent, ta->ta_cookie, TC_IPL_TTY, cfbintr, sc);
362 1.3 nisimura *(u_int8_t *)(sc->sc_dc->dc_vaddr + CX_OFFSET_IREQ) = 0;
363 1.1 nisimura
364 1.1 nisimura waa.console = console;
365 1.1 nisimura waa.scrdata = &cfb_screenlist;
366 1.1 nisimura waa.accessops = &cfb_accessops;
367 1.1 nisimura waa.accesscookie = sc;
368 1.1 nisimura
369 1.1 nisimura config_found(self, &waa, wsemuldisplaydevprint);
370 1.1 nisimura }
371 1.1 nisimura
372 1.1 nisimura int
373 1.1 nisimura cfbioctl(v, cmd, data, flag, p)
374 1.1 nisimura void *v;
375 1.1 nisimura u_long cmd;
376 1.1 nisimura caddr_t data;
377 1.1 nisimura int flag;
378 1.1 nisimura struct proc *p;
379 1.1 nisimura {
380 1.1 nisimura struct cfb_softc *sc = v;
381 1.1 nisimura struct fb_devconfig *dc = sc->sc_dc;
382 1.1 nisimura int turnoff;
383 1.1 nisimura
384 1.1 nisimura switch (cmd) {
385 1.1 nisimura case WSDISPLAYIO_GTYPE:
386 1.1 nisimura *(u_int *)data = WSDISPLAY_TYPE_CFB;
387 1.1 nisimura return (0);
388 1.1 nisimura
389 1.1 nisimura case WSDISPLAYIO_GINFO:
390 1.1 nisimura #define wsd_fbip ((struct wsdisplay_fbinfo *)data)
391 1.1 nisimura wsd_fbip->height = sc->sc_dc->dc_ht;
392 1.1 nisimura wsd_fbip->width = sc->sc_dc->dc_wid;
393 1.1 nisimura wsd_fbip->depth = sc->sc_dc->dc_depth;
394 1.1 nisimura wsd_fbip->cmsize = CMAP_SIZE;
395 1.1 nisimura #undef fbt
396 1.1 nisimura return (0);
397 1.1 nisimura
398 1.1 nisimura case WSDISPLAYIO_GETCMAP:
399 1.1 nisimura return get_cmap(sc, (struct wsdisplay_cmap *)data);
400 1.1 nisimura
401 1.1 nisimura case WSDISPLAYIO_PUTCMAP:
402 1.1 nisimura return set_cmap(sc, (struct wsdisplay_cmap *)data);
403 1.1 nisimura
404 1.1 nisimura case WSDISPLAYIO_SVIDEO:
405 1.1 nisimura turnoff = *(int *)data == WSDISPLAYIO_VIDEO_OFF;
406 1.1 nisimura if ((dc->dc_blanked == 0) ^ turnoff) {
407 1.1 nisimura dc->dc_blanked = turnoff;
408 1.3 nisimura /* XXX later XXX */
409 1.1 nisimura }
410 1.1 nisimura return (0);
411 1.1 nisimura
412 1.1 nisimura case WSDISPLAYIO_GVIDEO:
413 1.1 nisimura *(u_int *)data = dc->dc_blanked ?
414 1.1 nisimura WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON;
415 1.1 nisimura return (0);
416 1.1 nisimura
417 1.1 nisimura case WSDISPLAYIO_GCURPOS:
418 1.1 nisimura *(struct wsdisplay_curpos *)data = sc->sc_cursor.cc_pos;
419 1.1 nisimura return (0);
420 1.1 nisimura
421 1.1 nisimura case WSDISPLAYIO_SCURPOS:
422 1.1 nisimura set_curpos(sc, (struct wsdisplay_curpos *)data);
423 1.1 nisimura bt459_set_curpos(sc);
424 1.1 nisimura return (0);
425 1.1 nisimura
426 1.1 nisimura case WSDISPLAYIO_GCURMAX:
427 1.1 nisimura ((struct wsdisplay_curpos *)data)->x =
428 1.1 nisimura ((struct wsdisplay_curpos *)data)->y = CURSOR_MAX_SIZE;
429 1.1 nisimura return (0);
430 1.1 nisimura
431 1.1 nisimura case WSDISPLAYIO_GCURSOR:
432 1.1 nisimura return get_cursor(sc, (struct wsdisplay_cursor *)data);
433 1.1 nisimura
434 1.1 nisimura case WSDISPLAYIO_SCURSOR:
435 1.1 nisimura return set_cursor(sc, (struct wsdisplay_cursor *)data);
436 1.1 nisimura }
437 1.1 nisimura return ENOTTY;
438 1.1 nisimura }
439 1.1 nisimura
440 1.1 nisimura int
441 1.1 nisimura cfbmmap(v, offset, prot)
442 1.1 nisimura void *v;
443 1.1 nisimura off_t offset;
444 1.1 nisimura int prot;
445 1.1 nisimura {
446 1.1 nisimura struct cfb_softc *sc = v;
447 1.1 nisimura
448 1.5 mrg if (offset >= CX_FB_SIZE || offset < 0)
449 1.1 nisimura return (-1);
450 1.1 nisimura return machine_btop(sc->sc_dc->dc_paddr + offset);
451 1.1 nisimura }
452 1.1 nisimura
453 1.1 nisimura int
454 1.1 nisimura cfb_alloc_screen(v, type, cookiep, curxp, curyp, attrp)
455 1.1 nisimura void *v;
456 1.1 nisimura const struct wsscreen_descr *type;
457 1.1 nisimura void **cookiep;
458 1.1 nisimura int *curxp, *curyp;
459 1.1 nisimura long *attrp;
460 1.1 nisimura {
461 1.1 nisimura struct cfb_softc *sc = v;
462 1.1 nisimura long defattr;
463 1.1 nisimura
464 1.1 nisimura if (sc->nscreens > 0)
465 1.1 nisimura return (ENOMEM);
466 1.1 nisimura
467 1.1 nisimura *cookiep = &sc->sc_dc->dc_rcons; /* one and only for now */
468 1.1 nisimura *curxp = 0;
469 1.1 nisimura *curyp = 0;
470 1.1 nisimura rcons_alloc_attr(&sc->sc_dc->dc_rcons, 0, 0, 0, &defattr);
471 1.1 nisimura *attrp = defattr;
472 1.1 nisimura sc->nscreens++;
473 1.1 nisimura return (0);
474 1.1 nisimura }
475 1.1 nisimura
476 1.1 nisimura void
477 1.1 nisimura cfb_free_screen(v, cookie)
478 1.1 nisimura void *v;
479 1.1 nisimura void *cookie;
480 1.1 nisimura {
481 1.1 nisimura struct cfb_softc *sc = v;
482 1.1 nisimura
483 1.1 nisimura if (sc->sc_dc == &cfb_console_dc)
484 1.1 nisimura panic("cfb_free_screen: console");
485 1.1 nisimura
486 1.1 nisimura sc->nscreens--;
487 1.1 nisimura }
488 1.1 nisimura
489 1.1 nisimura void
490 1.1 nisimura cfb_show_screen(v, cookie)
491 1.1 nisimura void *v;
492 1.1 nisimura void *cookie;
493 1.1 nisimura {
494 1.1 nisimura }
495 1.1 nisimura
496 1.1 nisimura int
497 1.1 nisimura cfb_cnattach(addr)
498 1.1 nisimura tc_addr_t addr;
499 1.1 nisimura {
500 1.1 nisimura struct fb_devconfig *dcp = &cfb_console_dc;
501 1.1 nisimura long defattr;
502 1.1 nisimura
503 1.1 nisimura cfb_getdevconfig(addr, dcp);
504 1.1 nisimura
505 1.1 nisimura rcons_alloc_attr(&dcp->dc_rcons, 0, 0, 0, &defattr);
506 1.1 nisimura
507 1.1 nisimura wsdisplay_cnattach(&cfb_stdscreen, &dcp->dc_rcons,
508 1.1 nisimura 0, 0, defattr);
509 1.1 nisimura cfb_consaddr = addr;
510 1.1 nisimura return(0);
511 1.1 nisimura }
512 1.1 nisimura
513 1.1 nisimura
514 1.1 nisimura int
515 1.1 nisimura cfbintr(arg)
516 1.1 nisimura void *arg;
517 1.1 nisimura {
518 1.1 nisimura struct cfb_softc *sc = arg;
519 1.1 nisimura caddr_t cfbbase = (caddr_t)sc->sc_dc->dc_vaddr;
520 1.1 nisimura struct bt459reg *vdac;
521 1.1 nisimura int v;
522 1.1 nisimura
523 1.3 nisimura *(u_int8_t *)(cfbbase + CX_OFFSET_IREQ) = 0;
524 1.1 nisimura if (sc->sc_changed == 0)
525 1.1 nisimura return (1);
526 1.1 nisimura
527 1.3 nisimura vdac = (void *)(cfbbase + CX_BT459_OFFSET);
528 1.1 nisimura v = sc->sc_changed;
529 1.1 nisimura sc->sc_changed = 0;
530 1.1 nisimura if (v & DATA_ENB_CHANGED) {
531 1.12 nisimura SELECT(vdac, BT459_REG_CCR);
532 1.12 nisimura REG(vdac, bt_reg) = (sc->sc_curenb) ? 0xc0 : 0x00;
533 1.1 nisimura }
534 1.1 nisimura if (v & DATA_CURCMAP_CHANGED) {
535 1.1 nisimura u_int8_t *cp = sc->sc_cursor.cc_color;
536 1.1 nisimura
537 1.12 nisimura SELECT(vdac, BT459_REG_CCOLOR_2);
538 1.12 nisimura REG(vdac, bt_reg) = cp[1]; tc_wmb();
539 1.12 nisimura REG(vdac, bt_reg) = cp[3]; tc_wmb();
540 1.12 nisimura REG(vdac, bt_reg) = cp[5]; tc_wmb();
541 1.12 nisimura
542 1.12 nisimura REG(vdac, bt_reg) = cp[0]; tc_wmb();
543 1.12 nisimura REG(vdac, bt_reg) = cp[2]; tc_wmb();
544 1.12 nisimura REG(vdac, bt_reg) = cp[4]; tc_wmb();
545 1.1 nisimura }
546 1.1 nisimura if (v & DATA_CURSHAPE_CHANGED) {
547 1.3 nisimura u_int8_t *ip, *mp, img, msk;
548 1.3 nisimura u_int8_t u;
549 1.3 nisimura int bcnt;
550 1.3 nisimura
551 1.3 nisimura ip = (u_int8_t *)sc->sc_cursor.cc_image;
552 1.3 nisimura mp = (u_int8_t *)(sc->sc_cursor.cc_image + CURSOR_MAX_SIZE);
553 1.3 nisimura
554 1.3 nisimura bcnt = 0;
555 1.12 nisimura SELECT(vdac, BT459_REG_CRAM_BASE+0);
556 1.3 nisimura /* 64 pixel scan line is consisted with 16 byte cursor ram */
557 1.3 nisimura while (bcnt < sc->sc_cursor.cc_size.y * 16) {
558 1.3 nisimura /* pad right half 32 pixel when smaller than 33 */
559 1.3 nisimura if ((bcnt & 0x8) && sc->sc_cursor.cc_size.x < 33) {
560 1.12 nisimura REG(vdac, bt_reg) = 0; tc_wmb();
561 1.12 nisimura REG(vdac, bt_reg) = 0; tc_wmb();
562 1.3 nisimura }
563 1.3 nisimura else {
564 1.3 nisimura img = *ip++;
565 1.3 nisimura msk = *mp++;
566 1.3 nisimura img &= msk; /* cookie off image */
567 1.3 nisimura u = (msk & 0x0f) << 4 | (img & 0x0f);
568 1.12 nisimura REG(vdac, bt_reg) = shuffle[u]; tc_wmb();
569 1.3 nisimura u = (msk & 0xf0) | (img & 0xf0) >> 4;
570 1.12 nisimura REG(vdac, bt_reg) = shuffle[u]; tc_wmb();
571 1.3 nisimura }
572 1.3 nisimura bcnt += 2;
573 1.3 nisimura }
574 1.3 nisimura /* pad unoccupied scan lines */
575 1.3 nisimura while (bcnt < CURSOR_MAX_SIZE * 16) {
576 1.12 nisimura REG(vdac, bt_reg) = 0; tc_wmb();
577 1.12 nisimura REG(vdac, bt_reg) = 0; tc_wmb();
578 1.3 nisimura bcnt += 2;
579 1.1 nisimura }
580 1.1 nisimura }
581 1.1 nisimura if (v & DATA_CMAP_CHANGED) {
582 1.11 nisimura struct hwcmap256 *cm = &sc->sc_cmap;
583 1.1 nisimura int index;
584 1.1 nisimura
585 1.12 nisimura SELECT(vdac, 0);
586 1.1 nisimura for (index = 0; index < CMAP_SIZE; index++) {
587 1.12 nisimura REG(vdac, bt_cmap) = cm->r[index]; tc_wmb();
588 1.12 nisimura REG(vdac, bt_cmap) = cm->g[index]; tc_wmb();
589 1.12 nisimura REG(vdac, bt_cmap) = cm->b[index]; tc_wmb();
590 1.1 nisimura }
591 1.1 nisimura }
592 1.1 nisimura return (1);
593 1.1 nisimura }
594 1.1 nisimura
595 1.1 nisimura void
596 1.1 nisimura cfbinit(dc)
597 1.1 nisimura struct fb_devconfig *dc;
598 1.1 nisimura {
599 1.1 nisimura caddr_t cfbbase = (caddr_t)dc->dc_vaddr;
600 1.3 nisimura struct bt459reg *vdac = (void *)(cfbbase + CX_BT459_OFFSET);
601 1.1 nisimura int i;
602 1.1 nisimura
603 1.12 nisimura SELECT(vdac, BT459_REG_COMMAND_0);
604 1.12 nisimura REG(vdac, bt_reg) = 0x40; /* CMD0 */ tc_wmb();
605 1.12 nisimura REG(vdac, bt_reg) = 0x0; /* CMD1 */ tc_wmb();
606 1.12 nisimura REG(vdac, bt_reg) = 0xc0; /* CMD2 */ tc_wmb();
607 1.12 nisimura REG(vdac, bt_reg) = 0xff; /* PRM */ tc_wmb();
608 1.12 nisimura REG(vdac, bt_reg) = 0; /* 205 */ tc_wmb();
609 1.12 nisimura REG(vdac, bt_reg) = 0x0; /* PBM */ tc_wmb();
610 1.12 nisimura REG(vdac, bt_reg) = 0; /* 207 */ tc_wmb();
611 1.12 nisimura REG(vdac, bt_reg) = 0x0; /* ORM */ tc_wmb();
612 1.12 nisimura REG(vdac, bt_reg) = 0x0; /* OBM */ tc_wmb();
613 1.12 nisimura REG(vdac, bt_reg) = 0x0; /* ILV */ tc_wmb();
614 1.12 nisimura REG(vdac, bt_reg) = 0x0; /* TEST */ tc_wmb();
615 1.12 nisimura
616 1.12 nisimura SELECT(vdac, BT459_REG_CCR);
617 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
618 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
619 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
620 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
621 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
622 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
623 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
624 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
625 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
626 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
627 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
628 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
629 1.12 nisimura REG(vdac, bt_reg) = 0x0; tc_wmb();
630 1.3 nisimura
631 1.3 nisimura /* build sane colormap */
632 1.12 nisimura SELECT(vdac, 0);
633 1.12 nisimura REG(vdac, bt_cmap) = 0; tc_wmb();
634 1.12 nisimura REG(vdac, bt_cmap) = 0; tc_wmb();
635 1.12 nisimura REG(vdac, bt_cmap) = 0; tc_wmb();
636 1.3 nisimura for (i = 1; i < CMAP_SIZE; i++) {
637 1.12 nisimura REG(vdac, bt_cmap) = 0xff; tc_wmb();
638 1.12 nisimura REG(vdac, bt_cmap) = 0xff; tc_wmb();
639 1.12 nisimura REG(vdac, bt_cmap) = 0xff; tc_wmb();
640 1.3 nisimura }
641 1.3 nisimura
642 1.3 nisimura /* clear out cursor image */
643 1.12 nisimura SELECT(vdac, BT459_REG_CRAM_BASE);
644 1.3 nisimura for (i = 0; i < 1024; i++)
645 1.12 nisimura REG(vdac, bt_reg) = 0xff; tc_wmb();
646 1.3 nisimura
647 1.3 nisimura /*
648 1.3 nisimura * 2 bit/pixel cursor. Assign MSB for cursor mask and LSB for
649 1.3 nisimura * cursor image. CCOLOR_2 for mask color, while CCOLOR_3 for
650 1.3 nisimura * image color. CCOLOR_1 will be never used.
651 1.3 nisimura */
652 1.12 nisimura SELECT(vdac, BT459_REG_CCOLOR_1);
653 1.12 nisimura REG(vdac, bt_reg) = 0xff; tc_wmb();
654 1.12 nisimura REG(vdac, bt_reg) = 0xff; tc_wmb();
655 1.12 nisimura REG(vdac, bt_reg) = 0xff; tc_wmb();
656 1.12 nisimura
657 1.12 nisimura REG(vdac, bt_reg) = 0; tc_wmb();
658 1.12 nisimura REG(vdac, bt_reg) = 0; tc_wmb();
659 1.12 nisimura REG(vdac, bt_reg) = 0; tc_wmb();
660 1.12 nisimura
661 1.12 nisimura REG(vdac, bt_reg) = 0xff; tc_wmb();
662 1.12 nisimura REG(vdac, bt_reg) = 0xff; tc_wmb();
663 1.12 nisimura REG(vdac, bt_reg) = 0xff; tc_wmb();
664 1.1 nisimura }
665 1.1 nisimura
666 1.1 nisimura static int
667 1.1 nisimura get_cmap(sc, p)
668 1.1 nisimura struct cfb_softc *sc;
669 1.1 nisimura struct wsdisplay_cmap *p;
670 1.1 nisimura {
671 1.1 nisimura u_int index = p->index, count = p->count;
672 1.1 nisimura
673 1.1 nisimura if (index >= CMAP_SIZE || (index + count) > CMAP_SIZE)
674 1.1 nisimura return (EINVAL);
675 1.1 nisimura
676 1.9 mrg if (!uvm_useracc(p->red, count, B_WRITE) ||
677 1.9 mrg !uvm_useracc(p->green, count, B_WRITE) ||
678 1.9 mrg !uvm_useracc(p->blue, count, B_WRITE))
679 1.1 nisimura return (EFAULT);
680 1.1 nisimura
681 1.1 nisimura copyout(&sc->sc_cmap.r[index], p->red, count);
682 1.1 nisimura copyout(&sc->sc_cmap.g[index], p->green, count);
683 1.1 nisimura copyout(&sc->sc_cmap.b[index], p->blue, count);
684 1.1 nisimura
685 1.1 nisimura return (0);
686 1.1 nisimura }
687 1.1 nisimura
688 1.1 nisimura static int
689 1.1 nisimura set_cmap(sc, p)
690 1.1 nisimura struct cfb_softc *sc;
691 1.1 nisimura struct wsdisplay_cmap *p;
692 1.1 nisimura {
693 1.1 nisimura u_int index = p->index, count = p->count;
694 1.1 nisimura
695 1.1 nisimura if (index >= CMAP_SIZE || (index + count) > CMAP_SIZE)
696 1.1 nisimura return (EINVAL);
697 1.1 nisimura
698 1.9 mrg if (!uvm_useracc(p->red, count, B_READ) ||
699 1.9 mrg !uvm_useracc(p->green, count, B_READ) ||
700 1.9 mrg !uvm_useracc(p->blue, count, B_READ))
701 1.1 nisimura return (EFAULT);
702 1.1 nisimura
703 1.1 nisimura copyin(p->red, &sc->sc_cmap.r[index], count);
704 1.1 nisimura copyin(p->green, &sc->sc_cmap.g[index], count);
705 1.1 nisimura copyin(p->blue, &sc->sc_cmap.b[index], count);
706 1.1 nisimura
707 1.1 nisimura sc->sc_changed |= DATA_CMAP_CHANGED;
708 1.1 nisimura
709 1.1 nisimura return (0);
710 1.1 nisimura }
711 1.1 nisimura
712 1.1 nisimura static int
713 1.1 nisimura set_cursor(sc, p)
714 1.1 nisimura struct cfb_softc *sc;
715 1.1 nisimura struct wsdisplay_cursor *p;
716 1.1 nisimura {
717 1.1 nisimura #define cc (&sc->sc_cursor)
718 1.4 nisimura int v, index, count, icount;
719 1.1 nisimura
720 1.1 nisimura v = p->which;
721 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOCMAP) {
722 1.1 nisimura index = p->cmap.index;
723 1.1 nisimura count = p->cmap.count;
724 1.1 nisimura if (index >= 2 || (index + count) > 2)
725 1.1 nisimura return (EINVAL);
726 1.9 mrg if (!uvm_useracc(p->cmap.red, count, B_READ) ||
727 1.9 mrg !uvm_useracc(p->cmap.green, count, B_READ) ||
728 1.9 mrg !uvm_useracc(p->cmap.blue, count, B_READ))
729 1.1 nisimura return (EFAULT);
730 1.1 nisimura }
731 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOSHAPE) {
732 1.1 nisimura if (p->size.x > CURSOR_MAX_SIZE || p->size.y > CURSOR_MAX_SIZE)
733 1.1 nisimura return (EINVAL);
734 1.4 nisimura icount = ((p->size.x < 33) ? 4 : 8) * p->size.y;
735 1.9 mrg if (!uvm_useracc(p->image, icount, B_READ) ||
736 1.9 mrg !uvm_useracc(p->mask, icount, B_READ))
737 1.1 nisimura return (EFAULT);
738 1.1 nisimura }
739 1.1 nisimura if (v & (WSDISPLAY_CURSOR_DOPOS | WSDISPLAY_CURSOR_DOCUR)) {
740 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOCUR)
741 1.1 nisimura cc->cc_hot = p->hot;
742 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOPOS)
743 1.1 nisimura set_curpos(sc, &p->pos);
744 1.1 nisimura bt459_set_curpos(sc);
745 1.1 nisimura }
746 1.1 nisimura
747 1.1 nisimura sc->sc_changed = 0;
748 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOCUR) {
749 1.1 nisimura sc->sc_curenb = p->enable;
750 1.1 nisimura sc->sc_changed |= DATA_ENB_CHANGED;
751 1.1 nisimura }
752 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOCMAP) {
753 1.1 nisimura copyin(p->cmap.red, &cc->cc_color[index], count);
754 1.1 nisimura copyin(p->cmap.green, &cc->cc_color[index + 2], count);
755 1.1 nisimura copyin(p->cmap.blue, &cc->cc_color[index + 4], count);
756 1.1 nisimura sc->sc_changed |= DATA_CURCMAP_CHANGED;
757 1.1 nisimura }
758 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOSHAPE) {
759 1.1 nisimura cc->cc_size = p->size;
760 1.1 nisimura memset(cc->cc_image, 0, sizeof cc->cc_image);
761 1.4 nisimura copyin(p->image, cc->cc_image, icount);
762 1.4 nisimura copyin(p->mask, cc->cc_image+CURSOR_MAX_SIZE, icount);
763 1.1 nisimura sc->sc_changed |= DATA_CURSHAPE_CHANGED;
764 1.1 nisimura }
765 1.1 nisimura
766 1.1 nisimura return (0);
767 1.1 nisimura #undef cc
768 1.1 nisimura }
769 1.1 nisimura
770 1.1 nisimura static int
771 1.1 nisimura get_cursor(sc, p)
772 1.1 nisimura struct cfb_softc *sc;
773 1.1 nisimura struct wsdisplay_cursor *p;
774 1.1 nisimura {
775 1.1 nisimura return (ENOTTY); /* XXX */
776 1.1 nisimura }
777 1.1 nisimura
778 1.1 nisimura static void
779 1.1 nisimura set_curpos(sc, curpos)
780 1.1 nisimura struct cfb_softc *sc;
781 1.1 nisimura struct wsdisplay_curpos *curpos;
782 1.1 nisimura {
783 1.1 nisimura struct fb_devconfig *dc = sc->sc_dc;
784 1.1 nisimura int x = curpos->x, y = curpos->y;
785 1.1 nisimura
786 1.1 nisimura if (y < 0)
787 1.1 nisimura y = 0;
788 1.3 nisimura else if (y > dc->dc_ht)
789 1.3 nisimura y = dc->dc_ht;
790 1.1 nisimura if (x < 0)
791 1.1 nisimura x = 0;
792 1.3 nisimura else if (x > dc->dc_wid)
793 1.3 nisimura x = dc->dc_wid;
794 1.1 nisimura sc->sc_cursor.cc_pos.x = x;
795 1.1 nisimura sc->sc_cursor.cc_pos.y = y;
796 1.1 nisimura }
797 1.1 nisimura
798 1.1 nisimura void
799 1.1 nisimura bt459_set_curpos(sc)
800 1.1 nisimura struct cfb_softc *sc;
801 1.1 nisimura {
802 1.1 nisimura caddr_t cfbbase = (caddr_t)sc->sc_dc->dc_vaddr;
803 1.3 nisimura struct bt459reg *vdac = (void *)(cfbbase + CX_BT459_OFFSET);
804 1.3 nisimura int x, y, s;
805 1.1 nisimura
806 1.3 nisimura x = sc->sc_cursor.cc_pos.x - sc->sc_cursor.cc_hot.x;
807 1.3 nisimura y = sc->sc_cursor.cc_pos.y - sc->sc_cursor.cc_hot.y;
808 1.11 nisimura
809 1.11 nisimura x += sc->sc_cursor.cc_magic.x;
810 1.11 nisimura y += sc->sc_cursor.cc_magic.y;
811 1.1 nisimura
812 1.1 nisimura s = spltty();
813 1.1 nisimura
814 1.12 nisimura SELECT(vdac, BT459_REG_CURSOR_X_LOW);
815 1.12 nisimura REG(vdac, bt_reg) = x; tc_wmb();
816 1.12 nisimura REG(vdac, bt_reg) = x >> 8; tc_wmb();
817 1.12 nisimura REG(vdac, bt_reg) = y; tc_wmb();
818 1.12 nisimura REG(vdac, bt_reg) = y >> 8; tc_wmb();
819 1.1 nisimura
820 1.1 nisimura splx(s);
821 1.1 nisimura }
822