mgx.c revision 1.4.2.2 1 1.4.2.2 skrll /* $NetBSD: mgx.c,v 1.4.2.2 2015/04/06 15:18:13 skrll Exp $ */
2 1.4.2.2 skrll
3 1.4.2.2 skrll /*-
4 1.4.2.2 skrll * Copyright (c) 2014 Michael Lorenz
5 1.4.2.2 skrll * All rights reserved.
6 1.4.2.2 skrll *
7 1.4.2.2 skrll * Redistribution and use in source and binary forms, with or without
8 1.4.2.2 skrll * modification, are permitted provided that the following conditions
9 1.4.2.2 skrll * are met:
10 1.4.2.2 skrll * 1. Redistributions of source code must retain the above copyright
11 1.4.2.2 skrll * notice, this list of conditions and the following disclaimer.
12 1.4.2.2 skrll * 2. Redistributions in binary form must reproduce the above copyright
13 1.4.2.2 skrll * notice, this list of conditions and the following disclaimer in the
14 1.4.2.2 skrll * documentation and/or other materials provided with the distribution.
15 1.4.2.2 skrll *
16 1.4.2.2 skrll * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
17 1.4.2.2 skrll * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18 1.4.2.2 skrll * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19 1.4.2.2 skrll * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
20 1.4.2.2 skrll * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
21 1.4.2.2 skrll * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
22 1.4.2.2 skrll * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
23 1.4.2.2 skrll * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
24 1.4.2.2 skrll * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
25 1.4.2.2 skrll * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
26 1.4.2.2 skrll * POSSIBILITY OF SUCH DAMAGE.
27 1.4.2.2 skrll */
28 1.4.2.2 skrll
29 1.4.2.2 skrll /* a console driver for the SSB 4096V-MGX graphics card */
30 1.4.2.2 skrll
31 1.4.2.2 skrll #include <sys/cdefs.h>
32 1.4.2.2 skrll __KERNEL_RCSID(0, "$NetBSD: mgx.c,v 1.4.2.2 2015/04/06 15:18:13 skrll Exp $");
33 1.4.2.2 skrll
34 1.4.2.2 skrll #include <sys/param.h>
35 1.4.2.2 skrll #include <sys/systm.h>
36 1.4.2.2 skrll #include <sys/buf.h>
37 1.4.2.2 skrll #include <sys/device.h>
38 1.4.2.2 skrll #include <sys/ioctl.h>
39 1.4.2.2 skrll #include <sys/conf.h>
40 1.4.2.2 skrll #include <sys/kmem.h>
41 1.4.2.2 skrll
42 1.4.2.2 skrll #include <sys/bus.h>
43 1.4.2.2 skrll #include <machine/autoconf.h>
44 1.4.2.2 skrll
45 1.4.2.2 skrll #include <dev/sbus/sbusvar.h>
46 1.4.2.2 skrll #include <dev/sun/fbio.h>
47 1.4.2.2 skrll #include <dev/sun/fbvar.h>
48 1.4.2.2 skrll
49 1.4.2.2 skrll #include <dev/wscons/wsdisplayvar.h>
50 1.4.2.2 skrll #include <dev/wscons/wsconsio.h>
51 1.4.2.2 skrll #include <dev/wsfont/wsfont.h>
52 1.4.2.2 skrll #include <dev/rasops/rasops.h>
53 1.4.2.2 skrll
54 1.4.2.2 skrll #include <dev/wscons/wsdisplay_vconsvar.h>
55 1.4.2.2 skrll #include <dev/wscons/wsdisplay_glyphcachevar.h>
56 1.4.2.2 skrll
57 1.4.2.2 skrll #include <dev/ic/vgareg.h>
58 1.4.2.2 skrll #include <dev/sbus/mgxreg.h>
59 1.4.2.2 skrll
60 1.4.2.2 skrll #include "opt_wsemul.h"
61 1.4.2.2 skrll
62 1.4.2.2 skrll
63 1.4.2.2 skrll struct mgx_softc {
64 1.4.2.2 skrll device_t sc_dev;
65 1.4.2.2 skrll bus_space_tag_t sc_tag;
66 1.4.2.2 skrll bus_space_handle_t sc_blith;
67 1.4.2.2 skrll bus_space_handle_t sc_vgah;
68 1.4.2.2 skrll bus_addr_t sc_paddr;
69 1.4.2.2 skrll void *sc_fbaddr;
70 1.4.2.2 skrll int sc_width;
71 1.4.2.2 skrll int sc_height;
72 1.4.2.2 skrll int sc_stride;
73 1.4.2.2 skrll int sc_fbsize;
74 1.4.2.2 skrll int sc_mode;
75 1.4.2.2 skrll uint32_t sc_dec;
76 1.4.2.2 skrll u_char sc_cmap_red[256];
77 1.4.2.2 skrll u_char sc_cmap_green[256];
78 1.4.2.2 skrll u_char sc_cmap_blue[256];
79 1.4.2.2 skrll void (*sc_putchar)(void *, int, int, u_int, long);
80 1.4.2.2 skrll struct vcons_screen sc_console_screen;
81 1.4.2.2 skrll struct wsscreen_descr sc_defaultscreen_descr;
82 1.4.2.2 skrll const struct wsscreen_descr *sc_screens[1];
83 1.4.2.2 skrll struct wsscreen_list sc_screenlist;
84 1.4.2.2 skrll struct vcons_data vd;
85 1.4.2.2 skrll glyphcache sc_gc;
86 1.4.2.2 skrll };
87 1.4.2.2 skrll
88 1.4.2.2 skrll static int mgx_match(device_t, cfdata_t, void *);
89 1.4.2.2 skrll static void mgx_attach(device_t, device_t, void *);
90 1.4.2.2 skrll static int mgx_ioctl(void *, void *, u_long, void *, int,
91 1.4.2.2 skrll struct lwp*);
92 1.4.2.2 skrll static paddr_t mgx_mmap(void *, void *, off_t, int);
93 1.4.2.2 skrll static void mgx_init_screen(void *, struct vcons_screen *, int,
94 1.4.2.2 skrll long *);
95 1.4.2.2 skrll static void mgx_write_dac(struct mgx_softc *, int, int, int, int);
96 1.4.2.2 skrll static void mgx_setup(struct mgx_softc *, int);
97 1.4.2.2 skrll static void mgx_init_palette(struct mgx_softc *);
98 1.4.2.2 skrll static int mgx_putcmap(struct mgx_softc *, struct wsdisplay_cmap *);
99 1.4.2.2 skrll static int mgx_getcmap(struct mgx_softc *, struct wsdisplay_cmap *);
100 1.4.2.2 skrll static int mgx_wait_engine(struct mgx_softc *);
101 1.4.2.2 skrll static int mgx_wait_fifo(struct mgx_softc *, unsigned int);
102 1.4.2.2 skrll
103 1.4.2.2 skrll static void mgx_bitblt(void *, int, int, int, int, int, int, int);
104 1.4.2.2 skrll static void mgx_rectfill(void *, int, int, int, int, long);
105 1.4.2.2 skrll
106 1.4.2.2 skrll static void mgx_putchar(void *, int, int, u_int, long);
107 1.4.2.2 skrll static void mgx_cursor(void *, int, int, int);
108 1.4.2.2 skrll static void mgx_copycols(void *, int, int, int, int);
109 1.4.2.2 skrll static void mgx_erasecols(void *, int, int, int, long);
110 1.4.2.2 skrll static void mgx_copyrows(void *, int, int, int);
111 1.4.2.2 skrll static void mgx_eraserows(void *, int, int, long);
112 1.4.2.2 skrll
113 1.4.2.2 skrll CFATTACH_DECL_NEW(mgx, sizeof(struct mgx_softc),
114 1.4.2.2 skrll mgx_match, mgx_attach, NULL, NULL);
115 1.4.2.2 skrll
116 1.4.2.2 skrll struct wsdisplay_accessops mgx_accessops = {
117 1.4.2.2 skrll mgx_ioctl,
118 1.4.2.2 skrll mgx_mmap,
119 1.4.2.2 skrll NULL, /* vcons_alloc_screen */
120 1.4.2.2 skrll NULL, /* vcons_free_screen */
121 1.4.2.2 skrll NULL, /* vcons_show_screen */
122 1.4.2.2 skrll NULL, /* load_font */
123 1.4.2.2 skrll NULL, /* polls */
124 1.4.2.2 skrll NULL, /* scroll */
125 1.4.2.2 skrll };
126 1.4.2.2 skrll
127 1.4.2.2 skrll static int
128 1.4.2.2 skrll mgx_match(device_t parent, cfdata_t cf, void *aux)
129 1.4.2.2 skrll {
130 1.4.2.2 skrll struct sbus_attach_args *sa = aux;
131 1.4.2.2 skrll
132 1.4.2.2 skrll if (strcmp("SMSI,mgx", sa->sa_name) == 0)
133 1.4.2.2 skrll return 100;
134 1.4.2.2 skrll return 0;
135 1.4.2.2 skrll }
136 1.4.2.2 skrll
137 1.4.2.2 skrll /*
138 1.4.2.2 skrll * Attach a display. We need to notice if it is the console, too.
139 1.4.2.2 skrll */
140 1.4.2.2 skrll static void
141 1.4.2.2 skrll mgx_attach(device_t parent, device_t self, void *args)
142 1.4.2.2 skrll {
143 1.4.2.2 skrll struct mgx_softc *sc = device_private(self);
144 1.4.2.2 skrll struct sbus_attach_args *sa = args;
145 1.4.2.2 skrll struct wsemuldisplaydev_attach_args aa;
146 1.4.2.2 skrll struct rasops_info *ri;
147 1.4.2.2 skrll unsigned long defattr;
148 1.4.2.2 skrll bus_space_handle_t bh;
149 1.4.2.2 skrll int node = sa->sa_node;
150 1.4.2.2 skrll int isconsole;
151 1.4.2.2 skrll
152 1.4.2.2 skrll aprint_normal("\n");
153 1.4.2.2 skrll sc->sc_dev = self;
154 1.4.2.2 skrll sc->sc_tag = sa->sa_bustag;
155 1.4.2.2 skrll
156 1.4.2.2 skrll sc->sc_paddr = sbus_bus_addr(sa->sa_bustag, sa->sa_slot,
157 1.4.2.2 skrll sa->sa_reg[8].oa_base);
158 1.4.2.2 skrll
159 1.4.2.2 skrll /* read geometry information from the device tree */
160 1.4.2.2 skrll sc->sc_width = prom_getpropint(sa->sa_node, "width", 1152);
161 1.4.2.2 skrll sc->sc_height = prom_getpropint(sa->sa_node, "height", 900);
162 1.4.2.2 skrll sc->sc_stride = prom_getpropint(sa->sa_node, "linebytes", 900);
163 1.4.2.2 skrll sc->sc_fbsize = sc->sc_height * sc->sc_stride;
164 1.4.2.2 skrll sc->sc_fbaddr = NULL;
165 1.4.2.2 skrll if (sc->sc_fbaddr == NULL) {
166 1.4.2.2 skrll if (sbus_bus_map(sa->sa_bustag,
167 1.4.2.2 skrll sa->sa_slot,
168 1.4.2.2 skrll sa->sa_reg[8].oa_base,
169 1.4.2.2 skrll sc->sc_fbsize,
170 1.4.2.2 skrll BUS_SPACE_MAP_LINEAR | BUS_SPACE_MAP_LARGE,
171 1.4.2.2 skrll &bh) != 0) {
172 1.4.2.2 skrll aprint_error_dev(self, "cannot map framebuffer\n");
173 1.4.2.2 skrll return;
174 1.4.2.2 skrll }
175 1.4.2.2 skrll sc->sc_fbaddr = bus_space_vaddr(sa->sa_bustag, bh);
176 1.4.2.2 skrll }
177 1.4.2.2 skrll
178 1.4.2.2 skrll aprint_normal_dev(self, "%d x %d\n", sc->sc_width, sc->sc_height);
179 1.4.2.2 skrll
180 1.4.2.2 skrll if (sbus_bus_map(sa->sa_bustag,
181 1.4.2.2 skrll sa->sa_slot,
182 1.4.2.2 skrll sa->sa_reg[4].oa_base, 0x1000, 0,
183 1.4.2.2 skrll &sc->sc_vgah) != 0) {
184 1.4.2.2 skrll aprint_error("%s: couldn't map VGA registers\n",
185 1.4.2.2 skrll device_xname(sc->sc_dev));
186 1.4.2.2 skrll return;
187 1.4.2.2 skrll }
188 1.4.2.2 skrll
189 1.4.2.2 skrll if (sbus_bus_map(sa->sa_bustag,
190 1.4.2.2 skrll sa->sa_slot,
191 1.4.2.2 skrll sa->sa_reg[5].oa_base + MGX_REG_ATREG_OFFSET, 0x1000,
192 1.4.2.2 skrll 0, &sc->sc_blith) != 0) {
193 1.4.2.2 skrll aprint_error("%s: couldn't map blitter registers\n",
194 1.4.2.2 skrll device_xname(sc->sc_dev));
195 1.4.2.2 skrll return;
196 1.4.2.2 skrll }
197 1.4.2.2 skrll
198 1.4.2.2 skrll mgx_setup(sc, 8);
199 1.4.2.2 skrll
200 1.4.2.2 skrll sc->sc_defaultscreen_descr = (struct wsscreen_descr) {
201 1.4.2.2 skrll "default",
202 1.4.2.2 skrll 0, 0,
203 1.4.2.2 skrll NULL,
204 1.4.2.2 skrll 8, 16,
205 1.4.2.2 skrll WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
206 1.4.2.2 skrll NULL
207 1.4.2.2 skrll };
208 1.4.2.2 skrll sc->sc_screens[0] = &sc->sc_defaultscreen_descr;
209 1.4.2.2 skrll sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens};
210 1.4.2.2 skrll
211 1.4.2.2 skrll isconsole = fb_is_console(node);
212 1.4.2.2 skrll
213 1.4.2.2 skrll sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
214 1.4.2.2 skrll wsfont_init();
215 1.4.2.2 skrll
216 1.4.2.2 skrll vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr, &mgx_accessops);
217 1.4.2.2 skrll sc->vd.init_screen = mgx_init_screen;
218 1.4.2.2 skrll
219 1.4.2.2 skrll vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1, &defattr);
220 1.4.2.2 skrll sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
221 1.4.2.2 skrll
222 1.4.2.2 skrll ri = &sc->sc_console_screen.scr_ri;
223 1.4.2.2 skrll
224 1.4.2.2 skrll sc->sc_defaultscreen_descr.nrows = ri->ri_rows;
225 1.4.2.2 skrll sc->sc_defaultscreen_descr.ncols = ri->ri_cols;
226 1.4.2.2 skrll sc->sc_defaultscreen_descr.textops = &ri->ri_ops;
227 1.4.2.2 skrll sc->sc_defaultscreen_descr.capabilities = ri->ri_caps;
228 1.4.2.2 skrll
229 1.4.2.2 skrll sc->sc_gc.gc_bitblt = mgx_bitblt;
230 1.4.2.2 skrll sc->sc_gc.gc_rectfill = mgx_rectfill;
231 1.4.2.2 skrll sc->sc_gc.gc_blitcookie = sc;
232 1.4.2.2 skrll sc->sc_gc.gc_rop = ROP_SRC;
233 1.4.2.2 skrll
234 1.4.2.2 skrll glyphcache_init(&sc->sc_gc,
235 1.4.2.2 skrll sc->sc_height + 5,
236 1.4.2.2 skrll (0x400000 / sc->sc_stride) - sc->sc_height - 5,
237 1.4.2.2 skrll sc->sc_width,
238 1.4.2.2 skrll ri->ri_font->fontwidth,
239 1.4.2.2 skrll ri->ri_font->fontheight,
240 1.4.2.2 skrll defattr);
241 1.4.2.2 skrll
242 1.4.2.2 skrll mgx_init_palette(sc);
243 1.4.2.2 skrll
244 1.4.2.2 skrll if(isconsole) {
245 1.4.2.2 skrll wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0,
246 1.4.2.2 skrll defattr);
247 1.4.2.2 skrll vcons_replay_msgbuf(&sc->sc_console_screen);
248 1.4.2.2 skrll }
249 1.4.2.2 skrll
250 1.4.2.2 skrll aa.console = isconsole;
251 1.4.2.2 skrll aa.scrdata = &sc->sc_screenlist;
252 1.4.2.2 skrll aa.accessops = &mgx_accessops;
253 1.4.2.2 skrll aa.accesscookie = &sc->vd;
254 1.4.2.2 skrll
255 1.4.2.2 skrll config_found(self, &aa, wsemuldisplaydevprint);
256 1.4.2.2 skrll }
257 1.4.2.2 skrll
258 1.4.2.2 skrll static inline void
259 1.4.2.2 skrll mgx_write_vga(struct mgx_softc *sc, uint32_t reg, uint8_t val)
260 1.4.2.2 skrll {
261 1.4.2.2 skrll bus_space_write_1(sc->sc_tag, sc->sc_vgah, reg ^ 3, val);
262 1.4.2.2 skrll }
263 1.4.2.2 skrll
264 1.4.2.2 skrll static inline void
265 1.4.2.2 skrll mgx_write_1(struct mgx_softc *sc, uint32_t reg, uint8_t val)
266 1.4.2.2 skrll {
267 1.4.2.2 skrll bus_space_write_1(sc->sc_tag, sc->sc_blith, reg ^ 3, val);
268 1.4.2.2 skrll }
269 1.4.2.2 skrll
270 1.4.2.2 skrll static inline uint8_t
271 1.4.2.2 skrll mgx_read_1(struct mgx_softc *sc, uint32_t reg)
272 1.4.2.2 skrll {
273 1.4.2.2 skrll return bus_space_read_1(sc->sc_tag, sc->sc_blith, reg ^ 3);
274 1.4.2.2 skrll }
275 1.4.2.2 skrll
276 1.4.2.2 skrll static inline void
277 1.4.2.2 skrll mgx_write_4(struct mgx_softc *sc, uint32_t reg, uint32_t val)
278 1.4.2.2 skrll {
279 1.4.2.2 skrll bus_space_write_4(sc->sc_tag, sc->sc_blith, reg, val);
280 1.4.2.2 skrll }
281 1.4.2.2 skrll
282 1.4.2.2 skrll
283 1.4.2.2 skrll static void
284 1.4.2.2 skrll mgx_write_dac(struct mgx_softc *sc, int idx, int r, int g, int b)
285 1.4.2.2 skrll {
286 1.4.2.2 skrll mgx_write_vga(sc, VGA_BASE + VGA_DAC_ADDRW, idx);
287 1.4.2.2 skrll mgx_write_vga(sc, VGA_BASE + VGA_DAC_PALETTE, r);
288 1.4.2.2 skrll mgx_write_vga(sc, VGA_BASE + VGA_DAC_PALETTE, g);
289 1.4.2.2 skrll mgx_write_vga(sc, VGA_BASE + VGA_DAC_PALETTE, b);
290 1.4.2.2 skrll }
291 1.4.2.2 skrll
292 1.4.2.2 skrll static void
293 1.4.2.2 skrll mgx_init_palette(struct mgx_softc *sc)
294 1.4.2.2 skrll {
295 1.4.2.2 skrll struct rasops_info *ri = &sc->sc_console_screen.scr_ri;
296 1.4.2.2 skrll int i, j = 0;
297 1.4.2.2 skrll uint8_t cmap[768];
298 1.4.2.2 skrll
299 1.4.2.2 skrll rasops_get_cmap(ri, cmap, sizeof(cmap));
300 1.4.2.2 skrll for (i = 0; i < 256; i++) {
301 1.4.2.2 skrll sc->sc_cmap_red[i] = cmap[j];
302 1.4.2.2 skrll sc->sc_cmap_green[i] = cmap[j + 1];
303 1.4.2.2 skrll sc->sc_cmap_blue[i] = cmap[j + 2];
304 1.4.2.2 skrll mgx_write_dac(sc, i, cmap[j], cmap[j + 1], cmap[j + 2]);
305 1.4.2.2 skrll j += 3;
306 1.4.2.2 skrll }
307 1.4.2.2 skrll }
308 1.4.2.2 skrll
309 1.4.2.2 skrll static int
310 1.4.2.2 skrll mgx_putcmap(struct mgx_softc *sc, struct wsdisplay_cmap *cm)
311 1.4.2.2 skrll {
312 1.4.2.2 skrll u_char *r, *g, *b;
313 1.4.2.2 skrll u_int index = cm->index;
314 1.4.2.2 skrll u_int count = cm->count;
315 1.4.2.2 skrll int i, error;
316 1.4.2.2 skrll u_char rbuf[256], gbuf[256], bbuf[256];
317 1.4.2.2 skrll
318 1.4.2.2 skrll if (cm->index >= 256 || cm->count > 256 ||
319 1.4.2.2 skrll (cm->index + cm->count) > 256)
320 1.4.2.2 skrll return EINVAL;
321 1.4.2.2 skrll error = copyin(cm->red, &rbuf[index], count);
322 1.4.2.2 skrll if (error)
323 1.4.2.2 skrll return error;
324 1.4.2.2 skrll error = copyin(cm->green, &gbuf[index], count);
325 1.4.2.2 skrll if (error)
326 1.4.2.2 skrll return error;
327 1.4.2.2 skrll error = copyin(cm->blue, &bbuf[index], count);
328 1.4.2.2 skrll if (error)
329 1.4.2.2 skrll return error;
330 1.4.2.2 skrll
331 1.4.2.2 skrll memcpy(&sc->sc_cmap_red[index], &rbuf[index], count);
332 1.4.2.2 skrll memcpy(&sc->sc_cmap_green[index], &gbuf[index], count);
333 1.4.2.2 skrll memcpy(&sc->sc_cmap_blue[index], &bbuf[index], count);
334 1.4.2.2 skrll
335 1.4.2.2 skrll r = &sc->sc_cmap_red[index];
336 1.4.2.2 skrll g = &sc->sc_cmap_green[index];
337 1.4.2.2 skrll b = &sc->sc_cmap_blue[index];
338 1.4.2.2 skrll
339 1.4.2.2 skrll for (i = 0; i < count; i++) {
340 1.4.2.2 skrll mgx_write_dac(sc, index, *r, *g, *b);
341 1.4.2.2 skrll index++;
342 1.4.2.2 skrll r++, g++, b++;
343 1.4.2.2 skrll }
344 1.4.2.2 skrll return 0;
345 1.4.2.2 skrll }
346 1.4.2.2 skrll
347 1.4.2.2 skrll static int
348 1.4.2.2 skrll mgx_getcmap(struct mgx_softc *sc, struct wsdisplay_cmap *cm)
349 1.4.2.2 skrll {
350 1.4.2.2 skrll u_int index = cm->index;
351 1.4.2.2 skrll u_int count = cm->count;
352 1.4.2.2 skrll int error;
353 1.4.2.2 skrll
354 1.4.2.2 skrll if (index >= 255 || count > 256 || index + count > 256)
355 1.4.2.2 skrll return EINVAL;
356 1.4.2.2 skrll
357 1.4.2.2 skrll error = copyout(&sc->sc_cmap_red[index], cm->red, count);
358 1.4.2.2 skrll if (error)
359 1.4.2.2 skrll return error;
360 1.4.2.2 skrll error = copyout(&sc->sc_cmap_green[index], cm->green, count);
361 1.4.2.2 skrll if (error)
362 1.4.2.2 skrll return error;
363 1.4.2.2 skrll error = copyout(&sc->sc_cmap_blue[index], cm->blue, count);
364 1.4.2.2 skrll if (error)
365 1.4.2.2 skrll return error;
366 1.4.2.2 skrll
367 1.4.2.2 skrll return 0;
368 1.4.2.2 skrll }
369 1.4.2.2 skrll
370 1.4.2.2 skrll static int
371 1.4.2.2 skrll mgx_wait_engine(struct mgx_softc *sc)
372 1.4.2.2 skrll {
373 1.4.2.2 skrll unsigned int i;
374 1.4.2.2 skrll uint8_t stat;
375 1.4.2.2 skrll
376 1.4.2.2 skrll for (i = 100000; i != 0; i--) {
377 1.4.2.2 skrll stat = mgx_read_1(sc, ATR_BLT_STATUS);
378 1.4.2.2 skrll if ((stat & (BLT_HOST_BUSY | BLT_ENGINE_BUSY)) == 0)
379 1.4.2.2 skrll break;
380 1.4.2.2 skrll }
381 1.4.2.2 skrll
382 1.4.2.2 skrll return i;
383 1.4.2.2 skrll }
384 1.4.2.2 skrll
385 1.4.2.2 skrll static int
386 1.4.2.2 skrll mgx_wait_fifo(struct mgx_softc *sc, unsigned int nfifo)
387 1.4.2.2 skrll {
388 1.4.2.2 skrll unsigned int i;
389 1.4.2.2 skrll uint8_t stat;
390 1.4.2.2 skrll
391 1.4.2.2 skrll for (i = 100000; i != 0; i--) {
392 1.4.2.2 skrll stat = mgx_read_1(sc, ATR_FIFO_STATUS);
393 1.4.2.2 skrll stat = (stat & FIFO_MASK) >> FIFO_SHIFT;
394 1.4.2.2 skrll if (stat >= nfifo)
395 1.4.2.2 skrll break;
396 1.4.2.2 skrll mgx_write_1(sc, ATR_FIFO_STATUS, 0);
397 1.4.2.2 skrll }
398 1.4.2.2 skrll
399 1.4.2.2 skrll return i;
400 1.4.2.2 skrll }
401 1.4.2.2 skrll
402 1.4.2.2 skrll static void
403 1.4.2.2 skrll mgx_setup(struct mgx_softc *sc, int depth)
404 1.4.2.2 skrll {
405 1.4.2.2 skrll /* wait for everything to go idle */
406 1.4.2.2 skrll if (mgx_wait_engine(sc) == 0)
407 1.4.2.2 skrll return;
408 1.4.2.2 skrll if (mgx_wait_fifo(sc, FIFO_AT24) == 0)
409 1.4.2.2 skrll return;
410 1.4.2.2 skrll /*
411 1.4.2.2 skrll * Compute the invariant bits of the DEC register.
412 1.4.2.2 skrll */
413 1.4.2.2 skrll
414 1.4.2.2 skrll switch (depth) {
415 1.4.2.2 skrll case 8:
416 1.4.2.2 skrll sc->sc_dec = DEC_DEPTH_8 << DEC_DEPTH_SHIFT;
417 1.4.2.2 skrll break;
418 1.4.2.2 skrll case 15:
419 1.4.2.2 skrll case 16:
420 1.4.2.2 skrll sc->sc_dec = DEC_DEPTH_16 << DEC_DEPTH_SHIFT;
421 1.4.2.2 skrll break;
422 1.4.2.2 skrll case 32:
423 1.4.2.2 skrll sc->sc_dec = DEC_DEPTH_32 << DEC_DEPTH_SHIFT;
424 1.4.2.2 skrll break;
425 1.4.2.2 skrll default:
426 1.4.2.2 skrll return; /* not supported */
427 1.4.2.2 skrll }
428 1.4.2.2 skrll
429 1.4.2.2 skrll switch (sc->sc_stride) {
430 1.4.2.2 skrll case 640:
431 1.4.2.2 skrll sc->sc_dec |= DEC_WIDTH_640 << DEC_WIDTH_SHIFT;
432 1.4.2.2 skrll break;
433 1.4.2.2 skrll case 800:
434 1.4.2.2 skrll sc->sc_dec |= DEC_WIDTH_800 << DEC_WIDTH_SHIFT;
435 1.4.2.2 skrll break;
436 1.4.2.2 skrll case 1024:
437 1.4.2.2 skrll sc->sc_dec |= DEC_WIDTH_1024 << DEC_WIDTH_SHIFT;
438 1.4.2.2 skrll break;
439 1.4.2.2 skrll case 1152:
440 1.4.2.2 skrll sc->sc_dec |= DEC_WIDTH_1152 << DEC_WIDTH_SHIFT;
441 1.4.2.2 skrll break;
442 1.4.2.2 skrll case 1280:
443 1.4.2.2 skrll sc->sc_dec |= DEC_WIDTH_1280 << DEC_WIDTH_SHIFT;
444 1.4.2.2 skrll break;
445 1.4.2.2 skrll case 1600:
446 1.4.2.2 skrll sc->sc_dec |= DEC_WIDTH_1600 << DEC_WIDTH_SHIFT;
447 1.4.2.2 skrll break;
448 1.4.2.2 skrll default:
449 1.4.2.2 skrll return; /* not supported */
450 1.4.2.2 skrll }
451 1.4.2.2 skrll mgx_write_1(sc, ATR_CLIP_CONTROL, 0);
452 1.4.2.2 skrll mgx_write_1(sc, ATR_BYTEMASK, 0xff);
453 1.4.2.2 skrll }
454 1.4.2.2 skrll
455 1.4.2.2 skrll static void
456 1.4.2.2 skrll mgx_bitblt(void *cookie, int xs, int ys, int xd, int yd, int wi, int he,
457 1.4.2.2 skrll int rop)
458 1.4.2.2 skrll {
459 1.4.2.2 skrll struct mgx_softc *sc = cookie;
460 1.4.2.2 skrll uint32_t dec = sc->sc_dec;
461 1.4.2.2 skrll
462 1.4.2.2 skrll dec |= (DEC_COMMAND_BLT << DEC_COMMAND_SHIFT) |
463 1.4.2.2 skrll (DEC_START_DIMX << DEC_START_SHIFT);
464 1.4.2.2 skrll if (xs < xd) {
465 1.4.2.2 skrll xs += wi - 1;
466 1.4.2.2 skrll xd += wi - 1;
467 1.4.2.2 skrll dec |= DEC_DIR_X_REVERSE;
468 1.4.2.2 skrll }
469 1.4.2.2 skrll if (ys < yd) {
470 1.4.2.2 skrll ys += he - 1;
471 1.4.2.2 skrll yd += he - 1;
472 1.4.2.2 skrll dec |= DEC_DIR_Y_REVERSE;
473 1.4.2.2 skrll }
474 1.4.2.2 skrll mgx_wait_fifo(sc, 5);
475 1.4.2.2 skrll mgx_write_1(sc, ATR_ROP, rop);
476 1.4.2.2 skrll mgx_write_4(sc, ATR_DEC, dec);
477 1.4.2.2 skrll mgx_write_4(sc, ATR_SRC_XY, (ys << 16) | xs);
478 1.4.2.2 skrll mgx_write_4(sc, ATR_DST_XY, (yd << 16) | xd);
479 1.4.2.2 skrll mgx_write_4(sc, ATR_WH, (he << 16) | wi);
480 1.4.2.2 skrll }
481 1.4.2.2 skrll
482 1.4.2.2 skrll static void
483 1.4.2.2 skrll mgx_rectfill(void *cookie, int x, int y, int wi, int he, long fg)
484 1.4.2.2 skrll {
485 1.4.2.2 skrll struct mgx_softc *sc = cookie;
486 1.4.2.2 skrll struct vcons_screen *scr = sc->vd.active;
487 1.4.2.2 skrll uint32_t dec = sc->sc_dec;
488 1.4.2.2 skrll uint32_t col;
489 1.4.2.2 skrll
490 1.4.2.2 skrll if (scr == NULL)
491 1.4.2.2 skrll return;
492 1.4.2.2 skrll col = scr->scr_ri.ri_devcmap[fg];
493 1.4.2.2 skrll
494 1.4.2.2 skrll dec = sc->sc_dec;
495 1.4.2.2 skrll dec |= (DEC_COMMAND_RECT << DEC_COMMAND_SHIFT) |
496 1.4.2.2 skrll (DEC_START_DIMX << DEC_START_SHIFT);
497 1.4.2.2 skrll mgx_wait_fifo(sc, 5);
498 1.4.2.2 skrll mgx_write_1(sc, ATR_ROP, ROP_SRC);
499 1.4.2.2 skrll mgx_write_4(sc, ATR_FG, col);
500 1.4.2.2 skrll mgx_write_4(sc, ATR_DEC, dec);
501 1.4.2.2 skrll mgx_write_4(sc, ATR_DST_XY, (y << 16) | x);
502 1.4.2.2 skrll mgx_write_4(sc, ATR_WH, (he << 16) | wi);
503 1.4.2.2 skrll }
504 1.4.2.2 skrll
505 1.4.2.2 skrll static void
506 1.4.2.2 skrll mgx_putchar(void *cookie, int row, int col, u_int c, long attr)
507 1.4.2.2 skrll {
508 1.4.2.2 skrll struct rasops_info *ri = cookie;
509 1.4.2.2 skrll struct wsdisplay_font *font = PICK_FONT(ri, c);
510 1.4.2.2 skrll struct vcons_screen *scr = ri->ri_hw;
511 1.4.2.2 skrll struct mgx_softc *sc = scr->scr_cookie;
512 1.4.2.2 skrll uint32_t fg, bg;
513 1.4.2.2 skrll int x, y, wi, he, rv;
514 1.4.2.2 skrll
515 1.4.2.2 skrll wi = font->fontwidth;
516 1.4.2.2 skrll he = font->fontheight;
517 1.4.2.2 skrll
518 1.4.2.2 skrll bg = (attr >> 16) & 0xf;
519 1.4.2.2 skrll fg = (attr >> 24) & 0xf;
520 1.4.2.2 skrll
521 1.4.2.2 skrll x = ri->ri_xorigin + col * wi;
522 1.4.2.2 skrll y = ri->ri_yorigin + row * he;
523 1.4.2.2 skrll
524 1.4.2.2 skrll if (c == 0x20) {
525 1.4.2.2 skrll mgx_rectfill(sc, x, y, wi, he, bg);
526 1.4.2.2 skrll if (attr & 1)
527 1.4.2.2 skrll mgx_rectfill(sc, x, y + he - 2, wi, 1, fg);
528 1.4.2.2 skrll return;
529 1.4.2.2 skrll }
530 1.4.2.2 skrll rv = glyphcache_try(&sc->sc_gc, c, x, y, attr);
531 1.4.2.2 skrll if (rv != GC_OK) {
532 1.4.2.2 skrll volatile uint32_t junk;
533 1.4.2.2 skrll
534 1.4.2.2 skrll mgx_wait_engine(sc);
535 1.4.2.2 skrll sc->sc_putchar(cookie, row, col, c, attr & ~1);
536 1.4.2.2 skrll junk = *(uint32_t *)sc->sc_fbaddr;
537 1.4.2.2 skrll __USE(junk);
538 1.4.2.2 skrll if (rv == GC_ADD)
539 1.4.2.2 skrll glyphcache_add(&sc->sc_gc, c, x, y);
540 1.4.2.2 skrll }
541 1.4.2.2 skrll if (attr & 1)
542 1.4.2.2 skrll mgx_rectfill(sc, x, y + he - 2, wi, 1, fg);
543 1.4.2.2 skrll }
544 1.4.2.2 skrll
545 1.4.2.2 skrll static void
546 1.4.2.2 skrll mgx_cursor(void *cookie, int on, int row, int col)
547 1.4.2.2 skrll {
548 1.4.2.2 skrll struct rasops_info *ri = cookie;
549 1.4.2.2 skrll struct vcons_screen *scr = ri->ri_hw;
550 1.4.2.2 skrll struct mgx_softc *sc = scr->scr_cookie;
551 1.4.2.2 skrll int x, y, wi,he;
552 1.4.2.2 skrll
553 1.4.2.2 skrll wi = ri->ri_font->fontwidth;
554 1.4.2.2 skrll he = ri->ri_font->fontheight;
555 1.4.2.2 skrll
556 1.4.2.2 skrll if (ri->ri_flg & RI_CURSOR) {
557 1.4.2.2 skrll x = ri->ri_ccol * wi + ri->ri_xorigin;
558 1.4.2.2 skrll y = ri->ri_crow * he + ri->ri_yorigin;
559 1.4.2.2 skrll mgx_bitblt(sc, x, y, x, y, wi, he, ROP_INV);
560 1.4.2.2 skrll ri->ri_flg &= ~RI_CURSOR;
561 1.4.2.2 skrll }
562 1.4.2.2 skrll
563 1.4.2.2 skrll ri->ri_crow = row;
564 1.4.2.2 skrll ri->ri_ccol = col;
565 1.4.2.2 skrll
566 1.4.2.2 skrll if (on)
567 1.4.2.2 skrll {
568 1.4.2.2 skrll x = ri->ri_ccol * wi + ri->ri_xorigin;
569 1.4.2.2 skrll y = ri->ri_crow * he + ri->ri_yorigin;
570 1.4.2.2 skrll mgx_bitblt(sc, x, y, x, y, wi, he, ROP_INV);
571 1.4.2.2 skrll ri->ri_flg |= RI_CURSOR;
572 1.4.2.2 skrll }
573 1.4.2.2 skrll }
574 1.4.2.2 skrll
575 1.4.2.2 skrll static void
576 1.4.2.2 skrll mgx_copycols(void *cookie, int row, int srccol, int dstcol, int ncols)
577 1.4.2.2 skrll {
578 1.4.2.2 skrll struct rasops_info *ri = cookie;
579 1.4.2.2 skrll struct vcons_screen *scr = ri->ri_hw;
580 1.4.2.2 skrll struct mgx_softc *sc = scr->scr_cookie;
581 1.4.2.2 skrll int32_t xs, xd, y, width, height;
582 1.4.2.2 skrll
583 1.4.2.2 skrll xs = ri->ri_xorigin + ri->ri_font->fontwidth * srccol;
584 1.4.2.2 skrll xd = ri->ri_xorigin + ri->ri_font->fontwidth * dstcol;
585 1.4.2.2 skrll y = ri->ri_yorigin + ri->ri_font->fontheight * row;
586 1.4.2.2 skrll width = ri->ri_font->fontwidth * ncols;
587 1.4.2.2 skrll height = ri->ri_font->fontheight;
588 1.4.2.2 skrll mgx_bitblt(sc, xs, y, xd, y, width, height, ROP_SRC);
589 1.4.2.2 skrll }
590 1.4.2.2 skrll
591 1.4.2.2 skrll static void
592 1.4.2.2 skrll mgx_erasecols(void *cookie, int row, int startcol, int ncols, long fillattr)
593 1.4.2.2 skrll {
594 1.4.2.2 skrll struct rasops_info *ri = cookie;
595 1.4.2.2 skrll struct vcons_screen *scr = ri->ri_hw;
596 1.4.2.2 skrll struct mgx_softc *sc = scr->scr_cookie;
597 1.4.2.2 skrll int32_t x, y, width, height, bg;
598 1.4.2.2 skrll
599 1.4.2.2 skrll x = ri->ri_xorigin + ri->ri_font->fontwidth * startcol;
600 1.4.2.2 skrll y = ri->ri_yorigin + ri->ri_font->fontheight * row;
601 1.4.2.2 skrll width = ri->ri_font->fontwidth * ncols;
602 1.4.2.2 skrll height = ri->ri_font->fontheight;
603 1.4.2.2 skrll bg = (fillattr >> 16) & 0xff;
604 1.4.2.2 skrll mgx_rectfill(sc, x, y, width, height, bg);
605 1.4.2.2 skrll }
606 1.4.2.2 skrll
607 1.4.2.2 skrll static void
608 1.4.2.2 skrll mgx_copyrows(void *cookie, int srcrow, int dstrow, int nrows)
609 1.4.2.2 skrll {
610 1.4.2.2 skrll struct rasops_info *ri = cookie;
611 1.4.2.2 skrll struct vcons_screen *scr = ri->ri_hw;
612 1.4.2.2 skrll struct mgx_softc *sc = scr->scr_cookie;
613 1.4.2.2 skrll int32_t x, ys, yd, width, height;
614 1.4.2.2 skrll
615 1.4.2.2 skrll x = ri->ri_xorigin;
616 1.4.2.2 skrll ys = ri->ri_yorigin + ri->ri_font->fontheight * srcrow;
617 1.4.2.2 skrll yd = ri->ri_yorigin + ri->ri_font->fontheight * dstrow;
618 1.4.2.2 skrll width = ri->ri_emuwidth;
619 1.4.2.2 skrll height = ri->ri_font->fontheight * nrows;
620 1.4.2.2 skrll mgx_bitblt(sc, x, ys, x, yd, width, height, ROP_SRC);
621 1.4.2.2 skrll }
622 1.4.2.2 skrll
623 1.4.2.2 skrll static void
624 1.4.2.2 skrll mgx_eraserows(void *cookie, int row, int nrows, long fillattr)
625 1.4.2.2 skrll {
626 1.4.2.2 skrll struct rasops_info *ri = cookie;
627 1.4.2.2 skrll struct vcons_screen *scr = ri->ri_hw;
628 1.4.2.2 skrll struct mgx_softc *sc = scr->scr_cookie;
629 1.4.2.2 skrll int32_t x, y, width, height, bg;
630 1.4.2.2 skrll
631 1.4.2.2 skrll if ((row == 0) && (nrows == ri->ri_rows)) {
632 1.4.2.2 skrll x = y = 0;
633 1.4.2.2 skrll width = ri->ri_width;
634 1.4.2.2 skrll height = ri->ri_height;
635 1.4.2.2 skrll } else {
636 1.4.2.2 skrll x = ri->ri_xorigin;
637 1.4.2.2 skrll y = ri->ri_yorigin + ri->ri_font->fontheight * row;
638 1.4.2.2 skrll width = ri->ri_emuwidth;
639 1.4.2.2 skrll height = ri->ri_font->fontheight * nrows;
640 1.4.2.2 skrll }
641 1.4.2.2 skrll bg = (fillattr >> 16) & 0xff;
642 1.4.2.2 skrll mgx_rectfill(sc, x, y, width, height, bg);
643 1.4.2.2 skrll }
644 1.4.2.2 skrll
645 1.4.2.2 skrll static void
646 1.4.2.2 skrll mgx_init_screen(void *cookie, struct vcons_screen *scr,
647 1.4.2.2 skrll int existing, long *defattr)
648 1.4.2.2 skrll {
649 1.4.2.2 skrll struct mgx_softc *sc = cookie;
650 1.4.2.2 skrll struct rasops_info *ri = &scr->scr_ri;
651 1.4.2.2 skrll
652 1.4.2.2 skrll ri->ri_depth = 8;
653 1.4.2.2 skrll ri->ri_width = sc->sc_width;
654 1.4.2.2 skrll ri->ri_height = sc->sc_height;
655 1.4.2.2 skrll ri->ri_stride = sc->sc_stride;
656 1.4.2.2 skrll ri->ri_flg = RI_CENTER | RI_ENABLE_ALPHA;
657 1.4.2.2 skrll
658 1.4.2.2 skrll if (ri->ri_depth == 8)
659 1.4.2.2 skrll ri->ri_flg |= RI_8BIT_IS_RGB;
660 1.4.2.2 skrll
661 1.4.2.2 skrll ri->ri_bits = sc->sc_fbaddr;
662 1.4.2.2 skrll
663 1.4.2.2 skrll rasops_init(ri, 0, 0);
664 1.4.2.2 skrll sc->sc_putchar = ri->ri_ops.putchar;
665 1.4.2.2 skrll
666 1.4.2.2 skrll ri->ri_caps = WSSCREEN_REVERSE | WSSCREEN_WSCOLORS;
667 1.4.2.2 skrll
668 1.4.2.2 skrll rasops_reconfig(ri, ri->ri_height / ri->ri_font->fontheight,
669 1.4.2.2 skrll ri->ri_width / ri->ri_font->fontwidth);
670 1.4.2.2 skrll
671 1.4.2.2 skrll ri->ri_hw = scr;
672 1.4.2.2 skrll ri->ri_ops.putchar = mgx_putchar;
673 1.4.2.2 skrll ri->ri_ops.cursor = mgx_cursor;
674 1.4.2.2 skrll ri->ri_ops.copyrows = mgx_copyrows;
675 1.4.2.2 skrll ri->ri_ops.eraserows = mgx_eraserows;
676 1.4.2.2 skrll ri->ri_ops.copycols = mgx_copycols;
677 1.4.2.2 skrll ri->ri_ops.erasecols = mgx_erasecols;
678 1.4.2.2 skrll }
679 1.4.2.2 skrll
680 1.4.2.2 skrll static int
681 1.4.2.2 skrll mgx_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
682 1.4.2.2 skrll struct lwp *l)
683 1.4.2.2 skrll {
684 1.4.2.2 skrll struct vcons_data *vd = v;
685 1.4.2.2 skrll struct mgx_softc *sc = vd->cookie;
686 1.4.2.2 skrll struct wsdisplay_fbinfo *wdf;
687 1.4.2.2 skrll struct vcons_screen *ms = vd->active;
688 1.4.2.2 skrll
689 1.4.2.2 skrll switch (cmd) {
690 1.4.2.2 skrll case WSDISPLAYIO_GTYPE:
691 1.4.2.2 skrll *(u_int *)data = WSDISPLAY_TYPE_MGX;
692 1.4.2.2 skrll return 0;
693 1.4.2.2 skrll
694 1.4.2.2 skrll case WSDISPLAYIO_GINFO:
695 1.4.2.2 skrll wdf = (void *)data;
696 1.4.2.2 skrll wdf->height = sc->sc_height;
697 1.4.2.2 skrll wdf->width = sc->sc_width;
698 1.4.2.2 skrll wdf->depth = 8;
699 1.4.2.2 skrll wdf->cmsize = 256;
700 1.4.2.2 skrll return 0;
701 1.4.2.2 skrll
702 1.4.2.2 skrll case FBIOGVIDEO:
703 1.4.2.2 skrll case WSDISPLAYIO_GVIDEO:
704 1.4.2.2 skrll *(int *)data = 1;
705 1.4.2.2 skrll return 0;
706 1.4.2.2 skrll
707 1.4.2.2 skrll case WSDISPLAYIO_SVIDEO:
708 1.4.2.2 skrll case FBIOSVIDEO:
709 1.4.2.2 skrll return 0;
710 1.4.2.2 skrll
711 1.4.2.2 skrll case WSDISPLAYIO_LINEBYTES:
712 1.4.2.2 skrll {
713 1.4.2.2 skrll int *ret = (int *)data;
714 1.4.2.2 skrll *ret = sc->sc_stride;
715 1.4.2.2 skrll }
716 1.4.2.2 skrll return 0;
717 1.4.2.2 skrll
718 1.4.2.2 skrll case WSDISPLAYIO_SMODE:
719 1.4.2.2 skrll {
720 1.4.2.2 skrll int new_mode = *(int*)data;
721 1.4.2.2 skrll if (new_mode != sc->sc_mode)
722 1.4.2.2 skrll {
723 1.4.2.2 skrll sc->sc_mode = new_mode;
724 1.4.2.2 skrll if (new_mode == WSDISPLAYIO_MODE_EMUL)
725 1.4.2.2 skrll {
726 1.4.2.2 skrll mgx_setup(sc, 8);
727 1.4.2.2 skrll glyphcache_wipe(&sc->sc_gc);
728 1.4.2.2 skrll mgx_init_palette(sc);
729 1.4.2.2 skrll vcons_redraw_screen(ms);
730 1.4.2.2 skrll } else {
731 1.4.2.2 skrll mgx_setup(sc, 32);
732 1.4.2.2 skrll }
733 1.4.2.2 skrll }
734 1.4.2.2 skrll }
735 1.4.2.2 skrll return 0;
736 1.4.2.2 skrll
737 1.4.2.2 skrll case WSDISPLAYIO_GETCMAP:
738 1.4.2.2 skrll return mgx_getcmap(sc, (struct wsdisplay_cmap *)data);
739 1.4.2.2 skrll
740 1.4.2.2 skrll case WSDISPLAYIO_PUTCMAP:
741 1.4.2.2 skrll return mgx_putcmap(sc, (struct wsdisplay_cmap *)data);
742 1.4.2.2 skrll
743 1.4.2.2 skrll case WSDISPLAYIO_GET_FBINFO:
744 1.4.2.2 skrll {
745 1.4.2.2 skrll struct wsdisplayio_fbinfo *fbi = data;
746 1.4.2.2 skrll int ret;
747 1.4.2.2 skrll
748 1.4.2.2 skrll ret = wsdisplayio_get_fbinfo(&ms->scr_ri, fbi);
749 1.4.2.2 skrll fbi->fbi_fbsize = 0x400000;
750 1.4.2.2 skrll return ret;
751 1.4.2.2 skrll }
752 1.4.2.2 skrll }
753 1.4.2.2 skrll return EPASSTHROUGH;
754 1.4.2.2 skrll }
755 1.4.2.2 skrll
756 1.4.2.2 skrll static paddr_t
757 1.4.2.2 skrll mgx_mmap(void *v, void *vs, off_t offset, int prot)
758 1.4.2.2 skrll {
759 1.4.2.2 skrll struct vcons_data *vd = v;
760 1.4.2.2 skrll struct mgx_softc *sc = vd->cookie;
761 1.4.2.2 skrll
762 1.4.2.2 skrll /* regular fb mapping at 0 */
763 1.4.2.2 skrll if ((offset >= 0) && (offset < 0x400000)) {
764 1.4.2.2 skrll return bus_space_mmap(sc->sc_tag, sc->sc_paddr,
765 1.4.2.2 skrll offset, prot, BUS_SPACE_MAP_LINEAR);
766 1.4.2.2 skrll }
767 1.4.2.2 skrll
768 1.4.2.2 skrll return -1;
769 1.4.2.2 skrll }
770