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