genfb.c revision 1.8 1 1.8 jmmv /* $NetBSD: genfb.c,v 1.8 2007/08/30 13:32:18 jmmv Exp $ */
2 1.1 macallan
3 1.1 macallan /*-
4 1.1 macallan * Copyright (c) 2007 Michael Lorenz
5 1.1 macallan * All rights reserved.
6 1.1 macallan *
7 1.1 macallan * Redistribution and use in source and binary forms, with or without
8 1.1 macallan * modification, are permitted provided that the following conditions
9 1.1 macallan * are met:
10 1.1 macallan * 1. Redistributions of source code must retain the above copyright
11 1.1 macallan * notice, this list of conditions and the following disclaimer.
12 1.1 macallan * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 macallan * notice, this list of conditions and the following disclaimer in the
14 1.1 macallan * documentation and/or other materials provided with the distribution.
15 1.1 macallan * 3. Neither the name of The NetBSD Foundation nor the names of its
16 1.1 macallan * contributors may be used to endorse or promote products derived
17 1.1 macallan * from this software without specific prior written permission.
18 1.1 macallan *
19 1.1 macallan * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20 1.1 macallan * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21 1.1 macallan * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22 1.1 macallan * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23 1.1 macallan * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24 1.1 macallan * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25 1.1 macallan * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26 1.1 macallan * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27 1.1 macallan * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28 1.1 macallan * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29 1.1 macallan * POSSIBILITY OF SUCH DAMAGE.
30 1.1 macallan */
31 1.1 macallan
32 1.1 macallan #include <sys/cdefs.h>
33 1.8 jmmv __KERNEL_RCSID(0, "$NetBSD: genfb.c,v 1.8 2007/08/30 13:32:18 jmmv Exp $");
34 1.1 macallan
35 1.1 macallan #include <sys/param.h>
36 1.1 macallan #include <sys/systm.h>
37 1.1 macallan #include <sys/kernel.h>
38 1.1 macallan #include <sys/device.h>
39 1.1 macallan #include <sys/proc.h>
40 1.1 macallan #include <sys/mutex.h>
41 1.1 macallan #include <sys/ioctl.h>
42 1.1 macallan #include <sys/kernel.h>
43 1.1 macallan #include <sys/systm.h>
44 1.5 macallan #include <sys/malloc.h>
45 1.1 macallan
46 1.1 macallan #include <dev/wscons/wsconsio.h>
47 1.1 macallan #include <dev/wscons/wsdisplayvar.h>
48 1.1 macallan #include <dev/rasops/rasops.h>
49 1.1 macallan #include <dev/wsfont/wsfont.h>
50 1.1 macallan
51 1.1 macallan #include <dev/wscons/wsdisplay_vconsvar.h>
52 1.1 macallan
53 1.1 macallan #include <dev/wsfb/genfbvar.h>
54 1.1 macallan
55 1.1 macallan #include "opt_genfb.h"
56 1.1 macallan #include "opt_wsfb.h"
57 1.1 macallan
58 1.1 macallan static int genfb_ioctl(void *, void *, u_long, void *, int, struct lwp *);
59 1.1 macallan static paddr_t genfb_mmap(void *, void *, off_t, int);
60 1.1 macallan static void genfb_init_screen(void *, struct vcons_screen *, int, long *);
61 1.1 macallan
62 1.1 macallan static int genfb_putcmap(struct genfb_softc *, struct wsdisplay_cmap *);
63 1.1 macallan static int genfb_getcmap(struct genfb_softc *, struct wsdisplay_cmap *);
64 1.1 macallan static void genfb_restore_palette(struct genfb_softc *);
65 1.1 macallan static int genfb_putpalreg(struct genfb_softc *, uint8_t, uint8_t,
66 1.1 macallan uint8_t, uint8_t);
67 1.1 macallan
68 1.1 macallan extern const u_char rasops_cmap[768];
69 1.1 macallan
70 1.1 macallan struct wsdisplay_accessops genfb_accessops = {
71 1.1 macallan genfb_ioctl,
72 1.1 macallan genfb_mmap,
73 1.3 macallan NULL, /* alloc_screen */
74 1.3 macallan NULL, /* free_screen */
75 1.3 macallan NULL, /* show_screen */
76 1.3 macallan NULL, /* load_font */
77 1.3 macallan NULL, /* pollc */
78 1.3 macallan NULL /* scroll */
79 1.1 macallan };
80 1.1 macallan
81 1.2 macallan void
82 1.2 macallan genfb_init(struct genfb_softc *sc)
83 1.2 macallan {
84 1.2 macallan prop_dictionary_t dict;
85 1.4 macallan uint64_t cmap_cb;
86 1.2 macallan uint32_t fboffset;
87 1.2 macallan
88 1.2 macallan dict = device_properties(&sc->sc_dev);
89 1.2 macallan #ifdef GENFB_DEBUG
90 1.2 macallan printf(prop_dictionary_externalize(dict));
91 1.2 macallan #endif
92 1.2 macallan if (!prop_dictionary_get_uint32(dict, "width", &sc->sc_width))
93 1.2 macallan panic("no width property");
94 1.2 macallan if (!prop_dictionary_get_uint32(dict, "height", &sc->sc_height))
95 1.2 macallan panic("no height property");
96 1.2 macallan if (!prop_dictionary_get_uint32(dict, "depth", &sc->sc_depth))
97 1.2 macallan panic("no depth property");
98 1.2 macallan
99 1.2 macallan /* XXX should be a 64bit value */
100 1.2 macallan if (!prop_dictionary_get_uint32(dict, "address", &fboffset))
101 1.2 macallan panic("no address property");
102 1.2 macallan sc->sc_fboffset = fboffset;
103 1.2 macallan
104 1.2 macallan if (!prop_dictionary_get_uint32(dict, "linebytes", &sc->sc_stride))
105 1.2 macallan sc->sc_stride = (sc->sc_width * sc->sc_depth) >> 3;
106 1.6 macallan sc->sc_fbsize = sc->sc_height * sc->sc_stride;
107 1.4 macallan
108 1.4 macallan /* optional colour map callback */
109 1.4 macallan sc->sc_cmcb = NULL;
110 1.4 macallan if (prop_dictionary_get_uint64(dict, "cmap_callback", &cmap_cb)) {
111 1.4 macallan if (cmap_cb != 0)
112 1.4 macallan sc->sc_cmcb = (void *)(vaddr_t)cmap_cb;
113 1.4 macallan }
114 1.2 macallan }
115 1.2 macallan
116 1.2 macallan int
117 1.2 macallan genfb_attach(struct genfb_softc *sc, struct genfb_ops *ops)
118 1.1 macallan {
119 1.1 macallan struct wsemuldisplaydev_attach_args aa;
120 1.1 macallan prop_dictionary_t dict;
121 1.1 macallan struct rasops_info *ri;
122 1.1 macallan long defattr;
123 1.7 macallan int i, j;
124 1.7 macallan bool console;
125 1.1 macallan
126 1.1 macallan sc->sc_defaultscreen_descr = (struct wsscreen_descr){
127 1.1 macallan "default",
128 1.1 macallan 0, 0,
129 1.1 macallan NULL,
130 1.1 macallan 8, 16,
131 1.1 macallan WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
132 1.3 macallan NULL
133 1.1 macallan };
134 1.1 macallan sc->sc_screens[0] = &sc->sc_defaultscreen_descr;
135 1.1 macallan sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens};
136 1.1 macallan memcpy(&sc->sc_ops, ops, sizeof(struct genfb_ops));
137 1.1 macallan sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
138 1.1 macallan
139 1.5 macallan sc->sc_shadowfb = malloc(sc->sc_fbsize, M_DEVBUF, M_WAITOK);
140 1.5 macallan
141 1.1 macallan dict = device_properties(&sc->sc_dev);
142 1.1 macallan
143 1.1 macallan prop_dictionary_get_bool(dict, "is_console", &console);
144 1.1 macallan
145 1.1 macallan vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr,
146 1.1 macallan &genfb_accessops);
147 1.1 macallan sc->vd.init_screen = genfb_init_screen;
148 1.1 macallan
149 1.1 macallan ri = &sc->sc_console_screen.scr_ri;
150 1.1 macallan
151 1.1 macallan if (console) {
152 1.1 macallan vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1,
153 1.1 macallan &defattr);
154 1.1 macallan sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
155 1.1 macallan
156 1.1 macallan sc->sc_defaultscreen_descr.textops = &ri->ri_ops;
157 1.1 macallan sc->sc_defaultscreen_descr.capabilities = ri->ri_caps;
158 1.1 macallan sc->sc_defaultscreen_descr.nrows = ri->ri_rows;
159 1.1 macallan sc->sc_defaultscreen_descr.ncols = ri->ri_cols;
160 1.1 macallan wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0,
161 1.1 macallan defattr);
162 1.1 macallan } else {
163 1.1 macallan /*
164 1.1 macallan * since we're not the console we can postpone the rest
165 1.1 macallan * until someone actually allocates a screen for us
166 1.1 macallan */
167 1.1 macallan }
168 1.1 macallan
169 1.1 macallan j = 0;
170 1.8 jmmv for (i = 0; i < (1 << sc->sc_depth); i++) {
171 1.4 macallan
172 1.4 macallan sc->sc_cmap_red[i] = rasops_cmap[j];
173 1.4 macallan sc->sc_cmap_green[i] = rasops_cmap[j + 1];
174 1.4 macallan sc->sc_cmap_blue[i] = rasops_cmap[j + 2];
175 1.1 macallan genfb_putpalreg(sc, i, rasops_cmap[j], rasops_cmap[j + 1],
176 1.1 macallan rasops_cmap[j + 2]);
177 1.1 macallan j += 3;
178 1.1 macallan }
179 1.1 macallan
180 1.1 macallan aa.console = console;
181 1.1 macallan aa.scrdata = &sc->sc_screenlist;
182 1.1 macallan aa.accessops = &genfb_accessops;
183 1.1 macallan aa.accesscookie = &sc->vd;
184 1.1 macallan
185 1.1 macallan config_found(&sc->sc_dev, &aa, wsemuldisplaydevprint);
186 1.1 macallan
187 1.1 macallan return 0;
188 1.1 macallan }
189 1.1 macallan
190 1.1 macallan static int
191 1.1 macallan genfb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
192 1.1 macallan struct lwp *l)
193 1.1 macallan {
194 1.1 macallan struct vcons_data *vd = v;
195 1.1 macallan struct genfb_softc *sc = vd->cookie;
196 1.1 macallan struct wsdisplay_fbinfo *wdf;
197 1.1 macallan struct vcons_screen *ms = vd->active;
198 1.1 macallan
199 1.1 macallan switch (cmd) {
200 1.1 macallan
201 1.1 macallan case WSDISPLAYIO_GINFO:
202 1.6 macallan if (ms == NULL)
203 1.6 macallan return ENODEV;
204 1.1 macallan wdf = (void *)data;
205 1.1 macallan wdf->height = ms->scr_ri.ri_height;
206 1.1 macallan wdf->width = ms->scr_ri.ri_width;
207 1.1 macallan wdf->depth = ms->scr_ri.ri_depth;
208 1.1 macallan wdf->cmsize = 256;
209 1.1 macallan return 0;
210 1.1 macallan
211 1.1 macallan case WSDISPLAYIO_GETCMAP:
212 1.1 macallan return genfb_getcmap(sc,
213 1.1 macallan (struct wsdisplay_cmap *)data);
214 1.1 macallan
215 1.1 macallan case WSDISPLAYIO_PUTCMAP:
216 1.1 macallan return genfb_putcmap(sc,
217 1.1 macallan (struct wsdisplay_cmap *)data);
218 1.1 macallan
219 1.3 macallan case WSDISPLAYIO_LINEBYTES:
220 1.3 macallan *(u_int *)data = sc->sc_stride;
221 1.3 macallan return 0;
222 1.3 macallan
223 1.1 macallan case WSDISPLAYIO_SMODE:
224 1.1 macallan {
225 1.1 macallan int new_mode = *(int*)data;
226 1.1 macallan if (new_mode != sc->sc_mode) {
227 1.1 macallan sc->sc_mode = new_mode;
228 1.1 macallan if(new_mode == WSDISPLAYIO_MODE_EMUL) {
229 1.1 macallan genfb_restore_palette(sc);
230 1.1 macallan vcons_redraw_screen(ms);
231 1.1 macallan }
232 1.1 macallan }
233 1.1 macallan }
234 1.1 macallan return 0;
235 1.1 macallan default:
236 1.1 macallan if (sc->sc_ops.genfb_ioctl)
237 1.1 macallan return sc->sc_ops.genfb_ioctl(sc, vs, cmd,
238 1.1 macallan data, flag, l);
239 1.1 macallan }
240 1.1 macallan return EPASSTHROUGH;
241 1.1 macallan }
242 1.1 macallan
243 1.1 macallan static paddr_t
244 1.1 macallan genfb_mmap(void *v, void *vs, off_t offset, int prot)
245 1.1 macallan {
246 1.1 macallan struct vcons_data *vd = v;
247 1.1 macallan struct genfb_softc *sc = vd->cookie;
248 1.1 macallan
249 1.1 macallan if (sc->sc_ops.genfb_mmap)
250 1.1 macallan return sc->sc_ops.genfb_mmap(sc, vs, offset, prot);
251 1.1 macallan
252 1.1 macallan return -1;
253 1.1 macallan }
254 1.1 macallan
255 1.1 macallan static void
256 1.1 macallan genfb_init_screen(void *cookie, struct vcons_screen *scr,
257 1.1 macallan int existing, long *defattr)
258 1.1 macallan {
259 1.1 macallan struct genfb_softc *sc = cookie;
260 1.1 macallan struct rasops_info *ri = &scr->scr_ri;
261 1.1 macallan
262 1.1 macallan ri->ri_depth = sc->sc_depth;
263 1.1 macallan ri->ri_width = sc->sc_width;
264 1.1 macallan ri->ri_height = sc->sc_height;
265 1.1 macallan ri->ri_stride = sc->sc_stride;
266 1.1 macallan ri->ri_flg = RI_CENTER | RI_FULLCLEAR;
267 1.1 macallan
268 1.5 macallan if (sc->sc_shadowfb != NULL) {
269 1.5 macallan
270 1.5 macallan ri->ri_hwbits = (char *)sc->sc_fbaddr;
271 1.5 macallan ri->ri_bits = (char *)sc->sc_shadowfb;
272 1.5 macallan } else
273 1.5 macallan ri->ri_bits = (char *)sc->sc_fbaddr;
274 1.1 macallan
275 1.1 macallan if (existing) {
276 1.1 macallan ri->ri_flg |= RI_CLEAR;
277 1.1 macallan }
278 1.1 macallan
279 1.1 macallan rasops_init(ri, sc->sc_height / 8, sc->sc_width / 8);
280 1.1 macallan ri->ri_caps = WSSCREEN_WSCOLORS;
281 1.1 macallan
282 1.1 macallan rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
283 1.1 macallan sc->sc_width / ri->ri_font->fontwidth);
284 1.1 macallan
285 1.1 macallan ri->ri_hw = scr;
286 1.1 macallan }
287 1.1 macallan
288 1.1 macallan static int
289 1.1 macallan genfb_putcmap(struct genfb_softc *sc, struct wsdisplay_cmap *cm)
290 1.1 macallan {
291 1.1 macallan u_char *r, *g, *b;
292 1.1 macallan u_int index = cm->index;
293 1.1 macallan u_int count = cm->count;
294 1.1 macallan int i, error;
295 1.1 macallan u_char rbuf[256], gbuf[256], bbuf[256];
296 1.1 macallan
297 1.1 macallan #ifdef GENFB_DEBUG
298 1.1 macallan aprint_debug("putcmap: %d %d\n",index, count);
299 1.1 macallan #endif
300 1.1 macallan if (cm->index >= 256 || cm->count > 256 ||
301 1.1 macallan (cm->index + cm->count) > 256)
302 1.1 macallan return EINVAL;
303 1.1 macallan error = copyin(cm->red, &rbuf[index], count);
304 1.1 macallan if (error)
305 1.1 macallan return error;
306 1.1 macallan error = copyin(cm->green, &gbuf[index], count);
307 1.1 macallan if (error)
308 1.1 macallan return error;
309 1.1 macallan error = copyin(cm->blue, &bbuf[index], count);
310 1.1 macallan if (error)
311 1.1 macallan return error;
312 1.1 macallan
313 1.1 macallan memcpy(&sc->sc_cmap_red[index], &rbuf[index], count);
314 1.1 macallan memcpy(&sc->sc_cmap_green[index], &gbuf[index], count);
315 1.1 macallan memcpy(&sc->sc_cmap_blue[index], &bbuf[index], count);
316 1.1 macallan
317 1.1 macallan r = &sc->sc_cmap_red[index];
318 1.1 macallan g = &sc->sc_cmap_green[index];
319 1.1 macallan b = &sc->sc_cmap_blue[index];
320 1.1 macallan
321 1.1 macallan for (i = 0; i < count; i++) {
322 1.1 macallan genfb_putpalreg(sc, index, *r, *g, *b);
323 1.1 macallan index++;
324 1.1 macallan r++, g++, b++;
325 1.1 macallan }
326 1.1 macallan return 0;
327 1.1 macallan }
328 1.1 macallan
329 1.1 macallan static int
330 1.1 macallan genfb_getcmap(struct genfb_softc *sc, struct wsdisplay_cmap *cm)
331 1.1 macallan {
332 1.1 macallan u_int index = cm->index;
333 1.1 macallan u_int count = cm->count;
334 1.1 macallan int error;
335 1.1 macallan
336 1.1 macallan if (index >= 255 || count > 256 || index + count > 256)
337 1.1 macallan return EINVAL;
338 1.1 macallan
339 1.1 macallan error = copyout(&sc->sc_cmap_red[index], cm->red, count);
340 1.1 macallan if (error)
341 1.1 macallan return error;
342 1.1 macallan error = copyout(&sc->sc_cmap_green[index], cm->green, count);
343 1.1 macallan if (error)
344 1.1 macallan return error;
345 1.1 macallan error = copyout(&sc->sc_cmap_blue[index], cm->blue, count);
346 1.1 macallan if (error)
347 1.1 macallan return error;
348 1.1 macallan
349 1.1 macallan return 0;
350 1.1 macallan }
351 1.1 macallan
352 1.1 macallan static void
353 1.1 macallan genfb_restore_palette(struct genfb_softc *sc)
354 1.1 macallan {
355 1.1 macallan int i;
356 1.1 macallan
357 1.8 jmmv for (i = 0; i < (1 << sc->sc_depth); i++) {
358 1.1 macallan genfb_putpalreg(sc, i, sc->sc_cmap_red[i],
359 1.1 macallan sc->sc_cmap_green[i], sc->sc_cmap_blue[i]);
360 1.1 macallan }
361 1.1 macallan }
362 1.1 macallan
363 1.1 macallan static int
364 1.1 macallan genfb_putpalreg(struct genfb_softc *sc, uint8_t idx, uint8_t r, uint8_t g,
365 1.1 macallan uint8_t b)
366 1.1 macallan {
367 1.1 macallan
368 1.4 macallan if (sc->sc_cmcb) {
369 1.4 macallan
370 1.4 macallan sc->sc_cmcb->gcc_set_mapreg(sc->sc_cmcb->gcc_cookie,
371 1.4 macallan idx, r, g, b);
372 1.4 macallan }
373 1.1 macallan return 0;
374 1.1 macallan }
375 1.1 macallan
376