cfb.c revision 1.1 1 1.1 nisimura /* $NetBSD: cfb.c,v 1.1 1998/10/29 12:24:24 nisimura Exp $ */
2 1.1 nisimura
3 1.1 nisimura #include <sys/cdefs.h> /* RCS ID & Copyright macro defns */
4 1.1 nisimura
5 1.1 nisimura __KERNEL_RCSID(0, "$NetBSD: cfb.c,v 1.1 1998/10/29 12:24:24 nisimura Exp $");
6 1.1 nisimura
7 1.1 nisimura #include <sys/param.h>
8 1.1 nisimura #include <sys/systm.h>
9 1.1 nisimura #include <sys/kernel.h>
10 1.1 nisimura #include <sys/device.h>
11 1.1 nisimura #include <sys/malloc.h>
12 1.1 nisimura #include <sys/buf.h>
13 1.1 nisimura #include <sys/ioctl.h>
14 1.1 nisimura #include <vm/vm.h>
15 1.1 nisimura
16 1.1 nisimura #include <machine/bus.h>
17 1.1 nisimura #include <machine/intr.h>
18 1.1 nisimura
19 1.1 nisimura #include <dev/rcons/raster.h>
20 1.1 nisimura #include <dev/wscons/wsconsio.h>
21 1.1 nisimura #include <dev/wscons/wscons_raster.h>
22 1.1 nisimura #include <dev/wscons/wsdisplayvar.h>
23 1.1 nisimura #include <machine/autoconf.h>
24 1.1 nisimura
25 1.1 nisimura #include <dev/tc/tcvar.h>
26 1.1 nisimura #include <dev/ic/bt459reg.h>
27 1.1 nisimura
28 1.1 nisimura #include "opt_uvm.h"
29 1.1 nisimura #if defined(UVM)
30 1.1 nisimura #include <uvm/uvm_extern.h>
31 1.1 nisimura #define useracc uvm_useracc
32 1.1 nisimura #endif
33 1.1 nisimura
34 1.1 nisimura /* XXX BUS'IFYING XXX */
35 1.1 nisimura
36 1.1 nisimura #if defined(__pmax__)
37 1.1 nisimura #define machine_btop(x) mips_btop(x)
38 1.1 nisimura #define MACHINE_KSEG0_TO_PHYS(x) MIPS_KSEG1_TO_PHYS(x)
39 1.1 nisimura #endif
40 1.1 nisimura
41 1.1 nisimura #if defined(__alpha__) || defined(alpha)
42 1.1 nisimura /*
43 1.1 nisimura * Digital UNIX never supports PMAG-BA
44 1.1 nisimura */
45 1.1 nisimura #define machine_btop(x) alpha_btop(x)
46 1.1 nisimura #define MACHINE_KSEG0_TO_PHYS(x) ALPHA_K0SEG_TO_PHYS(x)
47 1.1 nisimura #endif
48 1.1 nisimura
49 1.1 nisimura /* XXX XXX XXX */
50 1.1 nisimura
51 1.1 nisimura /*
52 1.1 nisimura * N.B., Bt459 registers are 8bit width. Some of TC framebuffers have
53 1.1 nisimura * weird register layout such as each of 2nd and 3rd Bt459 registers
54 1.1 nisimura * is adjacent each other in a word, i.e.,
55 1.1 nisimura *
56 1.1 nisimura * struct bt459triplet {
57 1.1 nisimura * struct {
58 1.1 nisimura * u_int8_t u0;
59 1.1 nisimura * u_int8_t u1;
60 1.1 nisimura * u_int8_t u2;
61 1.1 nisimura * unsigned :8;
62 1.1 nisimura * } bt_lo;
63 1.1 nisimura * ...
64 1.1 nisimura *
65 1.1 nisimura * Although CX has single Bt459, 32bit R/W can be done w/o any trouble.
66 1.1 nisimura */
67 1.1 nisimura struct bt459reg {
68 1.1 nisimura u_int32_t bt_lo;
69 1.1 nisimura u_int32_t bt_hi;
70 1.1 nisimura u_int32_t bt_reg;
71 1.1 nisimura u_int32_t bt_cmap;
72 1.1 nisimura };
73 1.1 nisimura
74 1.1 nisimura struct fb_devconfig {
75 1.1 nisimura vaddr_t dc_vaddr; /* memory space virtual base address */
76 1.1 nisimura paddr_t dc_paddr; /* memory space physical base address */
77 1.1 nisimura vsize_t dc_size; /* size of slot memory */
78 1.1 nisimura int dc_wid; /* width of frame buffer */
79 1.1 nisimura int dc_ht; /* height of frame buffer */
80 1.1 nisimura int dc_depth; /* depth, bits per pixel */
81 1.1 nisimura int dc_rowbytes; /* bytes in a FB scan line */
82 1.1 nisimura vaddr_t dc_videobase; /* base of flat frame buffer */
83 1.1 nisimura struct raster dc_raster; /* raster description */
84 1.1 nisimura struct rcons dc_rcons; /* raster blitter control info */
85 1.1 nisimura int dc_blanked; /* currently has video disabled */
86 1.1 nisimura };
87 1.1 nisimura
88 1.1 nisimura struct hwcmap {
89 1.1 nisimura #define CMAP_SIZE 256 /* 256 R/G/B entries */
90 1.1 nisimura u_int8_t r[CMAP_SIZE];
91 1.1 nisimura u_int8_t g[CMAP_SIZE];
92 1.1 nisimura u_int8_t b[CMAP_SIZE];
93 1.1 nisimura };
94 1.1 nisimura
95 1.1 nisimura struct hwcursor {
96 1.1 nisimura struct wsdisplay_curpos cc_pos;
97 1.1 nisimura struct wsdisplay_curpos cc_hot;
98 1.1 nisimura struct wsdisplay_curpos cc_size;
99 1.1 nisimura #define CURSOR_MAX_SIZE 64
100 1.1 nisimura u_int8_t cc_color[6];
101 1.1 nisimura u_int64_t cc_image[64 + 64];
102 1.1 nisimura };
103 1.1 nisimura
104 1.1 nisimura struct cfb_softc {
105 1.1 nisimura struct device sc_dev;
106 1.1 nisimura struct fb_devconfig *sc_dc; /* device configuration */
107 1.1 nisimura struct hwcmap sc_cmap; /* software copy of colormap */
108 1.1 nisimura struct hwcursor sc_cursor; /* software copy of cursor */
109 1.1 nisimura int sc_curenb; /* cursor sprite enabled */
110 1.1 nisimura int sc_changed; /* need update of colormap */
111 1.1 nisimura #define DATA_ENB_CHANGED 0x01 /* cursor enable changed */
112 1.1 nisimura #define DATA_CURCMAP_CHANGED 0x02 /* cursor colormap changed */
113 1.1 nisimura #define DATA_CURSHAPE_CHANGED 0x04 /* cursor size, image, mask changed */
114 1.1 nisimura #define DATA_CMAP_CHANGED 0x08 /* colormap changed */
115 1.1 nisimura #define DATA_ALL_CHANGED 0x0f
116 1.1 nisimura int nscreens;
117 1.1 nisimura };
118 1.1 nisimura
119 1.1 nisimura int cfbmatch __P((struct device *, struct cfdata *, void *));
120 1.1 nisimura void cfbattach __P((struct device *, struct device *, void *));
121 1.1 nisimura
122 1.1 nisimura struct cfattach cfb_ca = {
123 1.1 nisimura sizeof(struct cfb_softc), cfbmatch, cfbattach,
124 1.1 nisimura };
125 1.1 nisimura
126 1.1 nisimura void cfb_getdevconfig __P((tc_addr_t, struct fb_devconfig *));
127 1.1 nisimura struct fb_devconfig cfb_console_dc;
128 1.1 nisimura tc_addr_t cfb_consaddr;
129 1.1 nisimura
130 1.1 nisimura struct wsdisplay_emulops cfb_emulops = {
131 1.1 nisimura rcons_cursor, /* could use hardware cursor; punt */
132 1.1 nisimura rcons_mapchar,
133 1.1 nisimura rcons_putchar,
134 1.1 nisimura rcons_copycols,
135 1.1 nisimura rcons_erasecols,
136 1.1 nisimura rcons_copyrows,
137 1.1 nisimura rcons_eraserows,
138 1.1 nisimura rcons_alloc_attr
139 1.1 nisimura };
140 1.1 nisimura
141 1.1 nisimura struct wsscreen_descr cfb_stdscreen = {
142 1.1 nisimura "std", 0, 0,
143 1.1 nisimura &cfb_emulops,
144 1.1 nisimura 0, 0,
145 1.1 nisimura 0
146 1.1 nisimura };
147 1.1 nisimura
148 1.1 nisimura const struct wsscreen_descr *_cfb_scrlist[] = {
149 1.1 nisimura &cfb_stdscreen,
150 1.1 nisimura };
151 1.1 nisimura
152 1.1 nisimura struct wsscreen_list cfb_screenlist = {
153 1.1 nisimura sizeof(_cfb_scrlist) / sizeof(struct wsscreen_descr *), _cfb_scrlist
154 1.1 nisimura };
155 1.1 nisimura
156 1.1 nisimura int cfbioctl __P((void *, u_long, caddr_t, int, struct proc *));
157 1.1 nisimura int cfbmmap __P((void *, off_t, int));
158 1.1 nisimura
159 1.1 nisimura int cfb_alloc_screen __P((void *, const struct wsscreen_descr *,
160 1.1 nisimura void **, int *, int *, long *));
161 1.1 nisimura void cfb_free_screen __P((void *, void *));
162 1.1 nisimura void cfb_show_screen __P((void *, void *));
163 1.1 nisimura int cfb_load_font __P((void *, void *, int, int, int, void *));
164 1.1 nisimura
165 1.1 nisimura struct wsdisplay_accessops cfb_accessops = {
166 1.1 nisimura cfbioctl,
167 1.1 nisimura cfbmmap,
168 1.1 nisimura cfb_alloc_screen,
169 1.1 nisimura cfb_free_screen,
170 1.1 nisimura cfb_show_screen,
171 1.1 nisimura cfb_load_font
172 1.1 nisimura };
173 1.1 nisimura
174 1.1 nisimura int cfb_cnattach __P((tc_addr_t));
175 1.1 nisimura int cfbintr __P((void *));
176 1.1 nisimura void cfbinit __P((struct fb_devconfig *));
177 1.1 nisimura
178 1.1 nisimura static int get_cmap __P((struct cfb_softc *, struct wsdisplay_cmap *));
179 1.1 nisimura static int set_cmap __P((struct cfb_softc *, struct wsdisplay_cmap *));
180 1.1 nisimura static int set_cursor __P((struct cfb_softc *, struct wsdisplay_cursor *));
181 1.1 nisimura static int get_cursor __P((struct cfb_softc *, struct wsdisplay_cursor *));
182 1.1 nisimura static void set_curpos __P((struct cfb_softc *, struct wsdisplay_curpos *));
183 1.1 nisimura static void bt459_set_curpos __P((struct cfb_softc *));
184 1.1 nisimura
185 1.1 nisimura /* XXX XXX XXX */
186 1.1 nisimura #define BT459_SELECT(vdac, regno) do { \
187 1.1 nisimura vdac->bt_lo = (regno) & 0x00ff; \
188 1.1 nisimura vdac->bt_hi = ((regno)& 0xff00) >> 8; \
189 1.1 nisimura tc_wmb(); \
190 1.1 nisimura } while (0)
191 1.1 nisimura /* XXX XXX XXX */
192 1.1 nisimura
193 1.1 nisimura #define CFB_FB_OFFSET 0x000000
194 1.1 nisimura #define CFB_FB_SIZE 0x100000
195 1.1 nisimura #define CFB_BT459_OFFSET 0x200000
196 1.1 nisimura #define CFB_OFFSET_IREQ 0x300000 /* Interrupt req. control */
197 1.1 nisimura
198 1.1 nisimura int
199 1.1 nisimura cfbmatch(parent, match, aux)
200 1.1 nisimura struct device *parent;
201 1.1 nisimura struct cfdata *match;
202 1.1 nisimura void *aux;
203 1.1 nisimura {
204 1.1 nisimura struct tc_attach_args *ta = aux;
205 1.1 nisimura
206 1.1 nisimura if (strncmp("PMAG-BA ", ta->ta_modname, TC_ROM_LLEN) != 0)
207 1.1 nisimura return (0);
208 1.1 nisimura
209 1.1 nisimura return (1);
210 1.1 nisimura }
211 1.1 nisimura
212 1.1 nisimura void
213 1.1 nisimura cfb_getdevconfig(dense_addr, dc)
214 1.1 nisimura tc_addr_t dense_addr;
215 1.1 nisimura struct fb_devconfig *dc;
216 1.1 nisimura {
217 1.1 nisimura struct raster *rap;
218 1.1 nisimura struct rcons *rcp;
219 1.1 nisimura int i;
220 1.1 nisimura
221 1.1 nisimura dc->dc_vaddr = dense_addr;
222 1.1 nisimura dc->dc_paddr = MACHINE_KSEG0_TO_PHYS(dc->dc_vaddr + CFB_FB_OFFSET);
223 1.1 nisimura
224 1.1 nisimura dc->dc_wid = 1024;
225 1.1 nisimura dc->dc_ht = 864;
226 1.1 nisimura dc->dc_depth = 8;
227 1.1 nisimura dc->dc_rowbytes = 1024;
228 1.1 nisimura dc->dc_videobase = dc->dc_vaddr + CFB_FB_OFFSET;
229 1.1 nisimura dc->dc_blanked = 0;
230 1.1 nisimura
231 1.1 nisimura /* initialize colormap and cursor resource */
232 1.1 nisimura cfbinit(dc);
233 1.1 nisimura
234 1.1 nisimura /* clear the screen */
235 1.1 nisimura for (i = 0; i < dc->dc_ht * dc->dc_rowbytes; i += sizeof(u_int32_t))
236 1.1 nisimura *(u_int32_t *)(dc->dc_videobase + i) = 0x0;
237 1.1 nisimura
238 1.1 nisimura /* initialize the raster */
239 1.1 nisimura rap = &dc->dc_raster;
240 1.1 nisimura rap->width = dc->dc_wid;
241 1.1 nisimura rap->height = dc->dc_ht;
242 1.1 nisimura rap->depth = dc->dc_depth;
243 1.1 nisimura rap->linelongs = dc->dc_rowbytes / sizeof(u_int32_t);
244 1.1 nisimura rap->pixels = (u_int32_t *)dc->dc_videobase;
245 1.1 nisimura
246 1.1 nisimura /* initialize the raster console blitter */
247 1.1 nisimura rcp = &dc->dc_rcons;
248 1.1 nisimura rcp->rc_sp = rap;
249 1.1 nisimura rcp->rc_crow = rcp->rc_ccol = -1;
250 1.1 nisimura rcp->rc_crowp = &rcp->rc_crow;
251 1.1 nisimura rcp->rc_ccolp = &rcp->rc_ccol;
252 1.1 nisimura rcons_init(rcp, 34, 80);
253 1.1 nisimura
254 1.1 nisimura cfb_stdscreen.nrows = dc->dc_rcons.rc_maxrow;
255 1.1 nisimura cfb_stdscreen.ncols = dc->dc_rcons.rc_maxcol;
256 1.1 nisimura }
257 1.1 nisimura
258 1.1 nisimura void
259 1.1 nisimura cfbattach(parent, self, aux)
260 1.1 nisimura struct device *parent, *self;
261 1.1 nisimura void *aux;
262 1.1 nisimura {
263 1.1 nisimura struct cfb_softc *sc = (struct cfb_softc *)self;
264 1.1 nisimura struct tc_attach_args *ta = aux;
265 1.1 nisimura struct wsemuldisplaydev_attach_args waa;
266 1.1 nisimura struct hwcmap *cm;
267 1.1 nisimura int console, i;
268 1.1 nisimura
269 1.1 nisimura console = (ta->ta_addr == cfb_consaddr);
270 1.1 nisimura if (console) {
271 1.1 nisimura sc->sc_dc = &cfb_console_dc;
272 1.1 nisimura sc->nscreens = 1;
273 1.1 nisimura }
274 1.1 nisimura else {
275 1.1 nisimura sc->sc_dc = (struct fb_devconfig *)
276 1.1 nisimura malloc(sizeof(struct fb_devconfig), M_DEVBUF, M_WAITOK);
277 1.1 nisimura cfb_getdevconfig(ta->ta_addr, sc->sc_dc);
278 1.1 nisimura }
279 1.1 nisimura printf(": %d x %d, %dbpp\n", sc->sc_dc->dc_wid, sc->sc_dc->dc_ht,
280 1.1 nisimura sc->sc_dc->dc_depth);
281 1.1 nisimura
282 1.1 nisimura cm = &sc->sc_cmap;
283 1.1 nisimura cm->r[0] = cm->g[0] = cm->b[0] = 0;
284 1.1 nisimura for (i = 1; i < CMAP_SIZE; i++) {
285 1.1 nisimura cm->r[i] = cm->g[i] = cm->b[i] = 0xff;
286 1.1 nisimura }
287 1.1 nisimura
288 1.1 nisimura /* Establish an interrupt handler, and clear any pending interrupts */
289 1.1 nisimura tc_intr_establish(parent, ta->ta_cookie, TC_IPL_TTY, cfbintr, sc);
290 1.1 nisimura *(u_int8_t *)(sc->sc_dc->dc_vaddr + CFB_OFFSET_IREQ) = 0;
291 1.1 nisimura
292 1.1 nisimura waa.console = console;
293 1.1 nisimura waa.scrdata = &cfb_screenlist;
294 1.1 nisimura waa.accessops = &cfb_accessops;
295 1.1 nisimura waa.accesscookie = sc;
296 1.1 nisimura
297 1.1 nisimura config_found(self, &waa, wsemuldisplaydevprint);
298 1.1 nisimura }
299 1.1 nisimura
300 1.1 nisimura int
301 1.1 nisimura cfbioctl(v, cmd, data, flag, p)
302 1.1 nisimura void *v;
303 1.1 nisimura u_long cmd;
304 1.1 nisimura caddr_t data;
305 1.1 nisimura int flag;
306 1.1 nisimura struct proc *p;
307 1.1 nisimura {
308 1.1 nisimura struct cfb_softc *sc = v;
309 1.1 nisimura struct fb_devconfig *dc = sc->sc_dc;
310 1.1 nisimura int turnoff;
311 1.1 nisimura
312 1.1 nisimura switch (cmd) {
313 1.1 nisimura case WSDISPLAYIO_GTYPE:
314 1.1 nisimura *(u_int *)data = WSDISPLAY_TYPE_CFB;
315 1.1 nisimura return (0);
316 1.1 nisimura
317 1.1 nisimura case WSDISPLAYIO_GINFO:
318 1.1 nisimura #define wsd_fbip ((struct wsdisplay_fbinfo *)data)
319 1.1 nisimura wsd_fbip->height = sc->sc_dc->dc_ht;
320 1.1 nisimura wsd_fbip->width = sc->sc_dc->dc_wid;
321 1.1 nisimura wsd_fbip->depth = sc->sc_dc->dc_depth;
322 1.1 nisimura wsd_fbip->cmsize = CMAP_SIZE;
323 1.1 nisimura #undef fbt
324 1.1 nisimura return (0);
325 1.1 nisimura
326 1.1 nisimura case WSDISPLAYIO_GETCMAP:
327 1.1 nisimura return get_cmap(sc, (struct wsdisplay_cmap *)data);
328 1.1 nisimura
329 1.1 nisimura case WSDISPLAYIO_PUTCMAP:
330 1.1 nisimura return set_cmap(sc, (struct wsdisplay_cmap *)data);
331 1.1 nisimura
332 1.1 nisimura case WSDISPLAYIO_SVIDEO:
333 1.1 nisimura turnoff = *(int *)data == WSDISPLAYIO_VIDEO_OFF;
334 1.1 nisimura if ((dc->dc_blanked == 0) ^ turnoff) {
335 1.1 nisimura /* sc->sc_changed |= DATA_ALL_CHANGED; */
336 1.1 nisimura dc->dc_blanked = turnoff;
337 1.1 nisimura }
338 1.1 nisimura return (0);
339 1.1 nisimura
340 1.1 nisimura case WSDISPLAYIO_GVIDEO:
341 1.1 nisimura *(u_int *)data = dc->dc_blanked ?
342 1.1 nisimura WSDISPLAYIO_VIDEO_OFF : WSDISPLAYIO_VIDEO_ON;
343 1.1 nisimura return (0);
344 1.1 nisimura
345 1.1 nisimura case WSDISPLAYIO_GCURPOS:
346 1.1 nisimura *(struct wsdisplay_curpos *)data = sc->sc_cursor.cc_pos;
347 1.1 nisimura return (0);
348 1.1 nisimura
349 1.1 nisimura case WSDISPLAYIO_SCURPOS:
350 1.1 nisimura set_curpos(sc, (struct wsdisplay_curpos *)data);
351 1.1 nisimura bt459_set_curpos(sc);
352 1.1 nisimura return (0);
353 1.1 nisimura
354 1.1 nisimura case WSDISPLAYIO_GCURMAX:
355 1.1 nisimura ((struct wsdisplay_curpos *)data)->x =
356 1.1 nisimura ((struct wsdisplay_curpos *)data)->y = CURSOR_MAX_SIZE;
357 1.1 nisimura return (0);
358 1.1 nisimura
359 1.1 nisimura case WSDISPLAYIO_GCURSOR:
360 1.1 nisimura return get_cursor(sc, (struct wsdisplay_cursor *)data);
361 1.1 nisimura
362 1.1 nisimura case WSDISPLAYIO_SCURSOR:
363 1.1 nisimura return set_cursor(sc, (struct wsdisplay_cursor *)data);
364 1.1 nisimura }
365 1.1 nisimura return ENOTTY;
366 1.1 nisimura }
367 1.1 nisimura
368 1.1 nisimura int
369 1.1 nisimura cfbmmap(v, offset, prot)
370 1.1 nisimura void *v;
371 1.1 nisimura off_t offset;
372 1.1 nisimura int prot;
373 1.1 nisimura {
374 1.1 nisimura struct cfb_softc *sc = v;
375 1.1 nisimura
376 1.1 nisimura if (offset > CFB_FB_SIZE)
377 1.1 nisimura return (-1);
378 1.1 nisimura return machine_btop(sc->sc_dc->dc_paddr + offset);
379 1.1 nisimura }
380 1.1 nisimura
381 1.1 nisimura int
382 1.1 nisimura cfb_alloc_screen(v, type, cookiep, curxp, curyp, attrp)
383 1.1 nisimura void *v;
384 1.1 nisimura const struct wsscreen_descr *type;
385 1.1 nisimura void **cookiep;
386 1.1 nisimura int *curxp, *curyp;
387 1.1 nisimura long *attrp;
388 1.1 nisimura {
389 1.1 nisimura struct cfb_softc *sc = v;
390 1.1 nisimura long defattr;
391 1.1 nisimura
392 1.1 nisimura if (sc->nscreens > 0)
393 1.1 nisimura return (ENOMEM);
394 1.1 nisimura
395 1.1 nisimura *cookiep = &sc->sc_dc->dc_rcons; /* one and only for now */
396 1.1 nisimura *curxp = 0;
397 1.1 nisimura *curyp = 0;
398 1.1 nisimura rcons_alloc_attr(&sc->sc_dc->dc_rcons, 0, 0, 0, &defattr);
399 1.1 nisimura *attrp = defattr;
400 1.1 nisimura sc->nscreens++;
401 1.1 nisimura return (0);
402 1.1 nisimura }
403 1.1 nisimura
404 1.1 nisimura void
405 1.1 nisimura cfb_free_screen(v, cookie)
406 1.1 nisimura void *v;
407 1.1 nisimura void *cookie;
408 1.1 nisimura {
409 1.1 nisimura struct cfb_softc *sc = v;
410 1.1 nisimura
411 1.1 nisimura if (sc->sc_dc == &cfb_console_dc)
412 1.1 nisimura panic("cfb_free_screen: console");
413 1.1 nisimura
414 1.1 nisimura sc->nscreens--;
415 1.1 nisimura }
416 1.1 nisimura
417 1.1 nisimura void
418 1.1 nisimura cfb_show_screen(v, cookie)
419 1.1 nisimura void *v;
420 1.1 nisimura void *cookie;
421 1.1 nisimura {
422 1.1 nisimura }
423 1.1 nisimura
424 1.1 nisimura int
425 1.1 nisimura cfb_load_font(v, cookie, first, num, stride, data)
426 1.1 nisimura void *v;
427 1.1 nisimura void *cookie;
428 1.1 nisimura int first, num, stride;
429 1.1 nisimura void *data;
430 1.1 nisimura {
431 1.1 nisimura return (EINVAL);
432 1.1 nisimura }
433 1.1 nisimura
434 1.1 nisimura int
435 1.1 nisimura cfb_cnattach(addr)
436 1.1 nisimura tc_addr_t addr;
437 1.1 nisimura {
438 1.1 nisimura struct fb_devconfig *dcp = &cfb_console_dc;
439 1.1 nisimura long defattr;
440 1.1 nisimura
441 1.1 nisimura cfb_getdevconfig(addr, dcp);
442 1.1 nisimura
443 1.1 nisimura rcons_alloc_attr(&dcp->dc_rcons, 0, 0, 0, &defattr);
444 1.1 nisimura
445 1.1 nisimura wsdisplay_cnattach(&cfb_stdscreen, &dcp->dc_rcons,
446 1.1 nisimura 0, 0, defattr);
447 1.1 nisimura cfb_consaddr = addr;
448 1.1 nisimura return(0);
449 1.1 nisimura }
450 1.1 nisimura
451 1.1 nisimura
452 1.1 nisimura int
453 1.1 nisimura cfbintr(arg)
454 1.1 nisimura void *arg;
455 1.1 nisimura {
456 1.1 nisimura struct cfb_softc *sc = arg;
457 1.1 nisimura caddr_t cfbbase = (caddr_t)sc->sc_dc->dc_vaddr;
458 1.1 nisimura struct bt459reg *vdac;
459 1.1 nisimura int v;
460 1.1 nisimura
461 1.1 nisimura *(u_int8_t *)(cfbbase + CFB_OFFSET_IREQ) = 0;
462 1.1 nisimura if (sc->sc_changed == 0)
463 1.1 nisimura return (1);
464 1.1 nisimura
465 1.1 nisimura vdac = (void *)(cfbbase + CFB_BT459_OFFSET);
466 1.1 nisimura v = sc->sc_changed;
467 1.1 nisimura sc->sc_changed = 0;
468 1.1 nisimura if (v & DATA_ENB_CHANGED) {
469 1.1 nisimura BT459_SELECT(vdac, BT459_REG_CCR);
470 1.1 nisimura vdac->bt_reg = (sc->sc_curenb) ? 0xc0 : 0x00;
471 1.1 nisimura }
472 1.1 nisimura if (v & DATA_CURCMAP_CHANGED) {
473 1.1 nisimura u_int8_t *cp = sc->sc_cursor.cc_color;
474 1.1 nisimura
475 1.1 nisimura BT459_SELECT(vdac, BT459_REG_CCOLOR_2);
476 1.1 nisimura vdac->bt_cmap = cp[1]; tc_wmb();
477 1.1 nisimura vdac->bt_cmap = cp[3]; tc_wmb();
478 1.1 nisimura vdac->bt_cmap = cp[5]; tc_wmb();
479 1.1 nisimura
480 1.1 nisimura BT459_SELECT(vdac, BT459_REG_CCOLOR_3);
481 1.1 nisimura vdac->bt_cmap = cp[0]; tc_wmb();
482 1.1 nisimura vdac->bt_cmap = cp[2]; tc_wmb();
483 1.1 nisimura vdac->bt_cmap = cp[4]; tc_wmb();
484 1.1 nisimura }
485 1.1 nisimura if (v & DATA_CURSHAPE_CHANGED) {
486 1.1 nisimura u_int8_t *bp;
487 1.1 nisimura int i;
488 1.1 nisimura
489 1.1 nisimura bp = (u_int8_t *)&sc->sc_cursor.cc_image;
490 1.1 nisimura BT459_SELECT(vdac, BT459_REG_CRAM_BASE);
491 1.1 nisimura for (i = 0; i < sizeof(sc->sc_cursor.cc_image); i++) {
492 1.1 nisimura vdac->bt_reg = *bp++;
493 1.1 nisimura tc_wmb();
494 1.1 nisimura }
495 1.1 nisimura }
496 1.1 nisimura if (v & DATA_CMAP_CHANGED) {
497 1.1 nisimura struct hwcmap *cm = &sc->sc_cmap;
498 1.1 nisimura int index;
499 1.1 nisimura
500 1.1 nisimura BT459_SELECT(vdac, 0);
501 1.1 nisimura for (index = 0; index < CMAP_SIZE; index++) {
502 1.1 nisimura vdac->bt_cmap = cm->r[index];
503 1.1 nisimura vdac->bt_cmap = cm->g[index];
504 1.1 nisimura vdac->bt_cmap = cm->b[index];
505 1.1 nisimura }
506 1.1 nisimura }
507 1.1 nisimura return (1);
508 1.1 nisimura }
509 1.1 nisimura
510 1.1 nisimura void
511 1.1 nisimura cfbinit(dc)
512 1.1 nisimura struct fb_devconfig *dc;
513 1.1 nisimura {
514 1.1 nisimura caddr_t cfbbase = (caddr_t)dc->dc_vaddr;
515 1.1 nisimura struct bt459reg *vdac = (void *)(cfbbase + CFB_BT459_OFFSET);
516 1.1 nisimura int i;
517 1.1 nisimura
518 1.1 nisimura BT459_SELECT(vdac, 0);
519 1.1 nisimura vdac->bt_cmap = 0; tc_wmb();
520 1.1 nisimura vdac->bt_cmap = 0; tc_wmb();
521 1.1 nisimura vdac->bt_cmap = 0; tc_wmb();
522 1.1 nisimura for (i = 1; i < CMAP_SIZE; i++) {
523 1.1 nisimura vdac->bt_cmap = 0xff; tc_wmb();
524 1.1 nisimura vdac->bt_cmap = 0xff; tc_wmb();
525 1.1 nisimura vdac->bt_cmap = 0xff; tc_wmb();
526 1.1 nisimura }
527 1.1 nisimura
528 1.1 nisimura BT459_SELECT(vdac, BT459_REG_COMMAND_0);
529 1.1 nisimura vdac->bt_reg = 0x40; /* CMD0 */ tc_wmb();
530 1.1 nisimura vdac->bt_reg = 0x0; /* CMD1 */ tc_wmb();
531 1.1 nisimura vdac->bt_reg = 0xc0; /* CMD2 */ tc_wmb();
532 1.1 nisimura vdac->bt_reg = 0xff; /* PRM */ tc_wmb();
533 1.1 nisimura vdac->bt_reg = 0; /* 205 */ tc_wmb();
534 1.1 nisimura vdac->bt_reg = 0x0; /* PBM */ tc_wmb();
535 1.1 nisimura vdac->bt_reg = 0; /* 207 */ tc_wmb();
536 1.1 nisimura vdac->bt_reg = 0x0; /* ORM */ tc_wmb();
537 1.1 nisimura vdac->bt_reg = 0x0; /* OBM */ tc_wmb();
538 1.1 nisimura vdac->bt_reg = 0x0; /* ILV */ tc_wmb();
539 1.1 nisimura vdac->bt_reg = 0x0; /* TEST */ tc_wmb();
540 1.1 nisimura
541 1.1 nisimura BT459_SELECT(vdac, BT459_REG_CCR);
542 1.1 nisimura vdac->bt_reg = 0x0; tc_wmb();
543 1.1 nisimura vdac->bt_reg = 0x0; tc_wmb();
544 1.1 nisimura vdac->bt_reg = 0x0; tc_wmb();
545 1.1 nisimura vdac->bt_reg = 0x0; tc_wmb();
546 1.1 nisimura vdac->bt_reg = 0x0; tc_wmb();
547 1.1 nisimura vdac->bt_reg = 0x0; tc_wmb();
548 1.1 nisimura vdac->bt_reg = 0x0; tc_wmb();
549 1.1 nisimura vdac->bt_reg = 0x0; tc_wmb();
550 1.1 nisimura vdac->bt_reg = 0x0; tc_wmb();
551 1.1 nisimura vdac->bt_reg = 0x0; tc_wmb();
552 1.1 nisimura vdac->bt_reg = 0x0; tc_wmb();
553 1.1 nisimura vdac->bt_reg = 0x0; tc_wmb();
554 1.1 nisimura vdac->bt_reg = 0x0; tc_wmb();
555 1.1 nisimura }
556 1.1 nisimura
557 1.1 nisimura static int
558 1.1 nisimura get_cmap(sc, p)
559 1.1 nisimura struct cfb_softc *sc;
560 1.1 nisimura struct wsdisplay_cmap *p;
561 1.1 nisimura {
562 1.1 nisimura u_int index = p->index, count = p->count;
563 1.1 nisimura
564 1.1 nisimura if (index >= CMAP_SIZE || (index + count) > CMAP_SIZE)
565 1.1 nisimura return (EINVAL);
566 1.1 nisimura
567 1.1 nisimura if (!useracc(p->red, count, B_WRITE) ||
568 1.1 nisimura !useracc(p->green, count, B_WRITE) ||
569 1.1 nisimura !useracc(p->blue, count, B_WRITE))
570 1.1 nisimura return (EFAULT);
571 1.1 nisimura
572 1.1 nisimura copyout(&sc->sc_cmap.r[index], p->red, count);
573 1.1 nisimura copyout(&sc->sc_cmap.g[index], p->green, count);
574 1.1 nisimura copyout(&sc->sc_cmap.b[index], p->blue, count);
575 1.1 nisimura
576 1.1 nisimura return (0);
577 1.1 nisimura }
578 1.1 nisimura
579 1.1 nisimura static int
580 1.1 nisimura set_cmap(sc, p)
581 1.1 nisimura struct cfb_softc *sc;
582 1.1 nisimura struct wsdisplay_cmap *p;
583 1.1 nisimura {
584 1.1 nisimura u_int index = p->index, count = p->count;
585 1.1 nisimura
586 1.1 nisimura if (index >= CMAP_SIZE || (index + count) > CMAP_SIZE)
587 1.1 nisimura return (EINVAL);
588 1.1 nisimura
589 1.1 nisimura if (!useracc(p->red, count, B_READ) ||
590 1.1 nisimura !useracc(p->green, count, B_READ) ||
591 1.1 nisimura !useracc(p->blue, count, B_READ))
592 1.1 nisimura return (EFAULT);
593 1.1 nisimura
594 1.1 nisimura copyin(p->red, &sc->sc_cmap.r[index], count);
595 1.1 nisimura copyin(p->green, &sc->sc_cmap.g[index], count);
596 1.1 nisimura copyin(p->blue, &sc->sc_cmap.b[index], count);
597 1.1 nisimura
598 1.1 nisimura sc->sc_changed |= DATA_CMAP_CHANGED;
599 1.1 nisimura
600 1.1 nisimura return (0);
601 1.1 nisimura }
602 1.1 nisimura
603 1.1 nisimura static int
604 1.1 nisimura set_cursor(sc, p)
605 1.1 nisimura struct cfb_softc *sc;
606 1.1 nisimura struct wsdisplay_cursor *p;
607 1.1 nisimura {
608 1.1 nisimura #define cc (&sc->sc_cursor)
609 1.1 nisimura int v, index, count;
610 1.1 nisimura
611 1.1 nisimura v = p->which;
612 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOCMAP) {
613 1.1 nisimura index = p->cmap.index;
614 1.1 nisimura count = p->cmap.count;
615 1.1 nisimura if (index >= 2 || (index + count) > 2)
616 1.1 nisimura return (EINVAL);
617 1.1 nisimura if (!useracc(p->cmap.red, count, B_READ) ||
618 1.1 nisimura !useracc(p->cmap.green, count, B_READ) ||
619 1.1 nisimura !useracc(p->cmap.blue, count, B_READ))
620 1.1 nisimura return (EFAULT);
621 1.1 nisimura }
622 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOSHAPE) {
623 1.1 nisimura if (p->size.x > CURSOR_MAX_SIZE || p->size.y > CURSOR_MAX_SIZE)
624 1.1 nisimura return (EINVAL);
625 1.1 nisimura count = (CURSOR_MAX_SIZE / NBBY) * p->size.y;
626 1.1 nisimura if (!useracc(p->image, count, B_READ) ||
627 1.1 nisimura !useracc(p->mask, count, B_READ))
628 1.1 nisimura return (EFAULT);
629 1.1 nisimura }
630 1.1 nisimura if (v & (WSDISPLAY_CURSOR_DOPOS | WSDISPLAY_CURSOR_DOCUR)) {
631 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOCUR)
632 1.1 nisimura cc->cc_hot = p->hot;
633 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOPOS)
634 1.1 nisimura set_curpos(sc, &p->pos);
635 1.1 nisimura bt459_set_curpos(sc);
636 1.1 nisimura }
637 1.1 nisimura
638 1.1 nisimura sc->sc_changed = 0;
639 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOCUR) {
640 1.1 nisimura sc->sc_curenb = p->enable;
641 1.1 nisimura sc->sc_changed |= DATA_ENB_CHANGED;
642 1.1 nisimura }
643 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOCMAP) {
644 1.1 nisimura count = p->cmap.count;
645 1.1 nisimura copyin(p->cmap.red, &cc->cc_color[index], count);
646 1.1 nisimura copyin(p->cmap.green, &cc->cc_color[index + 2], count);
647 1.1 nisimura copyin(p->cmap.blue, &cc->cc_color[index + 4], count);
648 1.1 nisimura sc->sc_changed |= DATA_CURCMAP_CHANGED;
649 1.1 nisimura }
650 1.1 nisimura if (v & WSDISPLAY_CURSOR_DOSHAPE) {
651 1.1 nisimura cc->cc_size = p->size;
652 1.1 nisimura memset(cc->cc_image, 0, sizeof cc->cc_image);
653 1.1 nisimura copyin(p->image, (caddr_t)cc->cc_image, count);
654 1.1 nisimura copyin(p->mask, (caddr_t)(cc->cc_image+CURSOR_MAX_SIZE), count);
655 1.1 nisimura sc->sc_changed |= DATA_CURSHAPE_CHANGED;
656 1.1 nisimura }
657 1.1 nisimura
658 1.1 nisimura return (0);
659 1.1 nisimura #undef cc
660 1.1 nisimura }
661 1.1 nisimura
662 1.1 nisimura static int
663 1.1 nisimura get_cursor(sc, p)
664 1.1 nisimura struct cfb_softc *sc;
665 1.1 nisimura struct wsdisplay_cursor *p;
666 1.1 nisimura {
667 1.1 nisimura return (ENOTTY); /* XXX */
668 1.1 nisimura }
669 1.1 nisimura
670 1.1 nisimura static void
671 1.1 nisimura set_curpos(sc, curpos)
672 1.1 nisimura struct cfb_softc *sc;
673 1.1 nisimura struct wsdisplay_curpos *curpos;
674 1.1 nisimura {
675 1.1 nisimura struct fb_devconfig *dc = sc->sc_dc;
676 1.1 nisimura int x = curpos->x, y = curpos->y;
677 1.1 nisimura
678 1.1 nisimura if (y < 0)
679 1.1 nisimura y = 0;
680 1.1 nisimura else if (y > dc->dc_ht - sc->sc_cursor.cc_size.y - 1)
681 1.1 nisimura y = dc->dc_ht - sc->sc_cursor.cc_size.y - 1;
682 1.1 nisimura if (x < 0)
683 1.1 nisimura x = 0;
684 1.1 nisimura else if (x > dc->dc_wid - sc->sc_cursor.cc_size.x - 1)
685 1.1 nisimura x = dc->dc_wid - sc->sc_cursor.cc_size.x - 1;
686 1.1 nisimura sc->sc_cursor.cc_pos.x = x;
687 1.1 nisimura sc->sc_cursor.cc_pos.y = y;
688 1.1 nisimura }
689 1.1 nisimura
690 1.1 nisimura void
691 1.1 nisimura bt459_set_curpos(sc)
692 1.1 nisimura struct cfb_softc *sc;
693 1.1 nisimura {
694 1.1 nisimura caddr_t cfbbase = (caddr_t)sc->sc_dc->dc_vaddr;
695 1.1 nisimura struct bt459reg *vdac = (void *)(cfbbase + CFB_BT459_OFFSET);
696 1.1 nisimura int x = 220, y = 35; /* magic offset of CX coordinate */
697 1.1 nisimura int s;
698 1.1 nisimura
699 1.1 nisimura x += sc->sc_cursor.cc_pos.x;
700 1.1 nisimura y += sc->sc_cursor.cc_pos.y;
701 1.1 nisimura
702 1.1 nisimura s = spltty();
703 1.1 nisimura
704 1.1 nisimura BT459_SELECT(vdac, BT459_REG_CURSOR_X_LOW);
705 1.1 nisimura vdac->bt_reg = x; tc_wmb();
706 1.1 nisimura vdac->bt_reg = x >> 8; tc_wmb();
707 1.1 nisimura vdac->bt_reg = y; tc_wmb();
708 1.1 nisimura vdac->bt_reg = y >> 8; tc_wmb();
709 1.1 nisimura
710 1.1 nisimura splx(s);
711 1.1 nisimura }
712