pm2fb.c revision 1.2 1 1.2 macallan /* $NetBSD: pm2fb.c,v 1.2 2009/10/28 04:25:13 macallan Exp $ */
2 1.1 macallan
3 1.1 macallan /*
4 1.1 macallan * Copyright (c) 2009 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 *
16 1.1 macallan * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 1.1 macallan * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 1.1 macallan * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 1.1 macallan * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 1.1 macallan * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21 1.1 macallan * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22 1.1 macallan * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23 1.1 macallan * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24 1.1 macallan * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25 1.1 macallan * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26 1.1 macallan */
27 1.1 macallan
28 1.1 macallan /*
29 1.1 macallan * A console driver for Permedia 2 graphics controllers
30 1.1 macallan * tested on sparc64 only so far
31 1.1 macallan */
32 1.1 macallan
33 1.1 macallan #include <sys/cdefs.h>
34 1.2 macallan __KERNEL_RCSID(0, "$NetBSD: pm2fb.c,v 1.2 2009/10/28 04:25:13 macallan Exp $");
35 1.1 macallan
36 1.1 macallan #include <sys/param.h>
37 1.1 macallan #include <sys/systm.h>
38 1.1 macallan #include <sys/kernel.h>
39 1.1 macallan #include <sys/device.h>
40 1.1 macallan #include <sys/malloc.h>
41 1.1 macallan #include <sys/lwp.h>
42 1.1 macallan #include <sys/kauth.h>
43 1.1 macallan
44 1.1 macallan #include <uvm/uvm_extern.h>
45 1.1 macallan
46 1.1 macallan #include <dev/videomode/videomode.h>
47 1.1 macallan
48 1.1 macallan #include <dev/pci/pcivar.h>
49 1.1 macallan #include <dev/pci/pcireg.h>
50 1.1 macallan #include <dev/pci/pcidevs.h>
51 1.1 macallan #include <dev/pci/pciio.h>
52 1.1 macallan #include <dev/pci/pm2reg.h>
53 1.1 macallan
54 1.1 macallan #include <dev/wscons/wsdisplayvar.h>
55 1.1 macallan #include <dev/wscons/wsconsio.h>
56 1.1 macallan #include <dev/wsfont/wsfont.h>
57 1.1 macallan #include <dev/rasops/rasops.h>
58 1.1 macallan #include <dev/wscons/wsdisplay_vconsvar.h>
59 1.1 macallan
60 1.1 macallan #include <dev/i2c/i2cvar.h>
61 1.1 macallan
62 1.1 macallan struct pm2fb_softc {
63 1.1 macallan device_t sc_dev;
64 1.1 macallan
65 1.1 macallan pci_chipset_tag_t sc_pc;
66 1.1 macallan pcitag_t sc_pcitag;
67 1.1 macallan
68 1.1 macallan bus_space_tag_t sc_memt;
69 1.1 macallan bus_space_tag_t sc_iot;
70 1.1 macallan
71 1.1 macallan bus_space_handle_t sc_fbh;
72 1.1 macallan bus_space_handle_t sc_regh;
73 1.1 macallan bus_addr_t sc_fb, sc_reg;
74 1.1 macallan bus_size_t sc_fbsize, sc_regsize;
75 1.1 macallan
76 1.1 macallan int sc_width, sc_height, sc_depth, sc_stride;
77 1.1 macallan int sc_locked;
78 1.1 macallan void *sc_fbaddr;
79 1.1 macallan struct vcons_screen sc_console_screen;
80 1.1 macallan struct wsscreen_descr sc_defaultscreen_descr;
81 1.1 macallan const struct wsscreen_descr *sc_screens[1];
82 1.1 macallan struct wsscreen_list sc_screenlist;
83 1.1 macallan struct vcons_data vd;
84 1.1 macallan int sc_mode;
85 1.1 macallan u_char sc_cmap_red[256];
86 1.1 macallan u_char sc_cmap_green[256];
87 1.1 macallan u_char sc_cmap_blue[256];
88 1.1 macallan /* engine stuff */
89 1.1 macallan uint32_t sc_master_cntl;
90 1.1 macallan };
91 1.1 macallan
92 1.1 macallan static int pm2fb_match(device_t, cfdata_t, void *);
93 1.1 macallan static void pm2fb_attach(device_t, device_t, void *);
94 1.1 macallan
95 1.1 macallan CFATTACH_DECL_NEW(pm2fb, sizeof(struct pm2fb_softc),
96 1.1 macallan pm2fb_match, pm2fb_attach, NULL, NULL);
97 1.1 macallan
98 1.1 macallan extern const u_char rasops_cmap[768];
99 1.1 macallan
100 1.1 macallan static int pm2fb_ioctl(void *, void *, u_long, void *, int,
101 1.1 macallan struct lwp *);
102 1.1 macallan static paddr_t pm2fb_mmap(void *, void *, off_t, int);
103 1.1 macallan static void pm2fb_init_screen(void *, struct vcons_screen *, int, long *);
104 1.1 macallan
105 1.1 macallan static int pm2fb_putcmap(struct pm2fb_softc *, struct wsdisplay_cmap *);
106 1.1 macallan static int pm2fb_getcmap(struct pm2fb_softc *, struct wsdisplay_cmap *);
107 1.1 macallan static void pm2fb_restore_palette(struct pm2fb_softc *);
108 1.1 macallan static int pm2fb_putpalreg(struct pm2fb_softc *, uint8_t, uint8_t,
109 1.1 macallan uint8_t, uint8_t);
110 1.1 macallan
111 1.1 macallan static void pm2fb_init(struct pm2fb_softc *);
112 1.1 macallan static void pm2fb_flush_engine(struct pm2fb_softc *);
113 1.1 macallan static void pm2fb_rectfill(struct pm2fb_softc *, int, int, int, int,
114 1.1 macallan uint32_t);
115 1.1 macallan static void pm2fb_bitblt(struct pm2fb_softc *, int, int, int, int, int,
116 1.1 macallan int, int);
117 1.1 macallan
118 1.1 macallan static void pm2fb_cursor(void *, int, int, int);
119 1.1 macallan #if 0
120 1.1 macallan static void pm2fb_putchar(void *, int, int, u_int, long);
121 1.1 macallan #endif
122 1.1 macallan static void pm2fb_copycols(void *, int, int, int, int);
123 1.1 macallan static void pm2fb_erasecols(void *, int, int, int, long);
124 1.1 macallan static void pm2fb_copyrows(void *, int, int, int);
125 1.1 macallan static void pm2fb_eraserows(void *, int, int, long);
126 1.1 macallan
127 1.1 macallan struct wsdisplay_accessops pm2fb_accessops = {
128 1.1 macallan pm2fb_ioctl,
129 1.1 macallan pm2fb_mmap,
130 1.1 macallan NULL, /* alloc_screen */
131 1.1 macallan NULL, /* free_screen */
132 1.1 macallan NULL, /* show_screen */
133 1.1 macallan NULL, /* load_font */
134 1.1 macallan NULL, /* pollc */
135 1.1 macallan NULL /* scroll */
136 1.1 macallan };
137 1.1 macallan
138 1.1 macallan static inline void
139 1.1 macallan pm2fb_wait(struct pm2fb_softc *sc, int slots)
140 1.1 macallan {
141 1.1 macallan uint32_t reg;
142 1.1 macallan
143 1.1 macallan do {
144 1.1 macallan reg = bus_space_read_4(sc->sc_memt, sc->sc_regh,
145 1.1 macallan PM2_INPUT_FIFO_SPACE);
146 1.1 macallan } while (reg <= slots);
147 1.1 macallan }
148 1.1 macallan
149 1.1 macallan static void
150 1.1 macallan pm2fb_flush_engine(struct pm2fb_softc *sc)
151 1.1 macallan {
152 1.1 macallan
153 1.1 macallan pm2fb_wait(sc, 2);
154 1.1 macallan
155 1.1 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_RE_FILTER_MODE,
156 1.1 macallan PM2FLT_PASS_SYNC);
157 1.1 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_RE_SYNC, 0);
158 1.1 macallan do {
159 1.1 macallan while (bus_space_read_4(sc->sc_memt, sc->sc_regh,
160 1.1 macallan PM2_OUTPUT_FIFO_WORDS) == 0);
161 1.1 macallan } while (bus_space_read_4(sc->sc_memt, sc->sc_regh, PM2_OUTPUT_FIFO) !=
162 1.1 macallan 0x188);
163 1.1 macallan }
164 1.1 macallan
165 1.1 macallan static int
166 1.1 macallan pm2fb_match(device_t parent, cfdata_t match, void *aux)
167 1.1 macallan {
168 1.1 macallan struct pci_attach_args *pa = (struct pci_attach_args *)aux;
169 1.1 macallan
170 1.1 macallan if (PCI_CLASS(pa->pa_class) != PCI_CLASS_DISPLAY)
171 1.1 macallan return 0;
172 1.1 macallan if (PCI_VENDOR(pa->pa_id) != PCI_VENDOR_3DLABS)
173 1.1 macallan return 0;
174 1.1 macallan
175 1.1 macallan /* only cards tested on so far - likely need a list */
176 1.1 macallan if ((PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_3DLABS_PERMEDIA2) ||
177 1.1 macallan (PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_3DLABS_PERMEDIA2V))
178 1.1 macallan return 100;
179 1.1 macallan return (0);
180 1.1 macallan }
181 1.1 macallan
182 1.1 macallan static void
183 1.1 macallan pm2fb_attach(device_t parent, device_t self, void *aux)
184 1.1 macallan {
185 1.1 macallan struct pm2fb_softc *sc = device_private(self);
186 1.1 macallan struct pci_attach_args *pa = aux;
187 1.1 macallan struct rasops_info *ri;
188 1.1 macallan char devinfo[256];
189 1.1 macallan struct wsemuldisplaydev_attach_args aa;
190 1.1 macallan prop_dictionary_t dict;
191 1.1 macallan unsigned long defattr;
192 1.1 macallan bool is_console;
193 1.1 macallan int i, j;
194 1.1 macallan
195 1.1 macallan sc->sc_pc = pa->pa_pc;
196 1.1 macallan sc->sc_pcitag = pa->pa_tag;
197 1.1 macallan sc->sc_memt = pa->pa_memt;
198 1.1 macallan sc->sc_iot = pa->pa_iot;
199 1.1 macallan sc->sc_dev = self;
200 1.1 macallan
201 1.1 macallan pci_devinfo(pa->pa_id, pa->pa_class, 0, devinfo, sizeof(devinfo));
202 1.1 macallan aprint_normal(": %s\n", devinfo);
203 1.1 macallan
204 1.1 macallan /* fill in parameters from properties */
205 1.1 macallan dict = device_properties(self);
206 1.1 macallan if (!prop_dictionary_get_uint32(dict, "width", &sc->sc_width)) {
207 1.1 macallan aprint_error("%s: no width property\n", device_xname(self));
208 1.1 macallan return;
209 1.1 macallan }
210 1.1 macallan if (!prop_dictionary_get_uint32(dict, "height", &sc->sc_height)) {
211 1.1 macallan aprint_error("%s: no height property\n", device_xname(self));
212 1.1 macallan return;
213 1.1 macallan }
214 1.1 macallan if (!prop_dictionary_get_uint32(dict, "depth", &sc->sc_depth)) {
215 1.1 macallan aprint_error("%s: no depth property\n", device_xname(self));
216 1.1 macallan return;
217 1.1 macallan }
218 1.1 macallan /*
219 1.1 macallan * don't look at the linebytes property - The Raptor firmware lies
220 1.1 macallan * about it. Get it from width * depth >> 3 instead.
221 1.1 macallan */
222 1.1 macallan sc->sc_stride = sc->sc_width * (sc->sc_depth >> 3);
223 1.1 macallan
224 1.1 macallan prop_dictionary_get_bool(dict, "is_console", &is_console);
225 1.1 macallan
226 1.1 macallan if (pci_mapreg_map(pa, 0x14, PCI_MAPREG_TYPE_MEM,
227 1.1 macallan BUS_SPACE_MAP_LINEAR,
228 1.1 macallan &sc->sc_memt, &sc->sc_fbh, &sc->sc_fb, &sc->sc_fbsize)) {
229 1.1 macallan aprint_error("%s: failed to map the frame buffer.\n",
230 1.1 macallan device_xname(sc->sc_dev));
231 1.1 macallan }
232 1.1 macallan sc->sc_fbaddr = bus_space_vaddr(sc->sc_memt, sc->sc_fbh);
233 1.1 macallan
234 1.1 macallan if (pci_mapreg_map(pa, 0x10, PCI_MAPREG_TYPE_MEM, 0,
235 1.1 macallan &sc->sc_memt, &sc->sc_regh, &sc->sc_reg, &sc->sc_regsize)) {
236 1.1 macallan aprint_error("%s: failed to map registers.\n",
237 1.1 macallan device_xname(sc->sc_dev));
238 1.1 macallan }
239 1.1 macallan
240 1.1 macallan /*
241 1.1 macallan * XXX yeah, casting the fb address to uint32_t is formally wrong
242 1.1 macallan * but as far as I know there are no PM2 with 64bit BARs
243 1.1 macallan */
244 1.1 macallan aprint_normal("%s: %d MB aperture at 0x%08x\n", device_xname(self),
245 1.1 macallan (int)(sc->sc_fbsize >> 20), (uint32_t)sc->sc_fb);
246 1.1 macallan
247 1.1 macallan sc->sc_defaultscreen_descr = (struct wsscreen_descr){
248 1.1 macallan "default",
249 1.1 macallan 0, 0,
250 1.1 macallan NULL,
251 1.1 macallan 8, 16,
252 1.1 macallan WSSCREEN_WSCOLORS | WSSCREEN_HILIT,
253 1.1 macallan NULL
254 1.1 macallan };
255 1.1 macallan sc->sc_screens[0] = &sc->sc_defaultscreen_descr;
256 1.1 macallan sc->sc_screenlist = (struct wsscreen_list){1, sc->sc_screens};
257 1.1 macallan sc->sc_mode = WSDISPLAYIO_MODE_EMUL;
258 1.1 macallan sc->sc_locked = 0;
259 1.1 macallan
260 1.1 macallan vcons_init(&sc->vd, sc, &sc->sc_defaultscreen_descr,
261 1.1 macallan &pm2fb_accessops);
262 1.1 macallan sc->vd.init_screen = pm2fb_init_screen;
263 1.1 macallan
264 1.1 macallan /* init engine here */
265 1.1 macallan pm2fb_init(sc);
266 1.1 macallan
267 1.1 macallan ri = &sc->sc_console_screen.scr_ri;
268 1.1 macallan
269 1.1 macallan j = 0;
270 1.1 macallan for (i = 0; i < (1 << sc->sc_depth); i++) {
271 1.1 macallan
272 1.1 macallan sc->sc_cmap_red[i] = rasops_cmap[j];
273 1.1 macallan sc->sc_cmap_green[i] = rasops_cmap[j + 1];
274 1.1 macallan sc->sc_cmap_blue[i] = rasops_cmap[j + 2];
275 1.1 macallan pm2fb_putpalreg(sc, i, rasops_cmap[j], rasops_cmap[j + 1],
276 1.1 macallan rasops_cmap[j + 2]);
277 1.1 macallan j += 3;
278 1.1 macallan }
279 1.1 macallan
280 1.1 macallan if (is_console) {
281 1.1 macallan vcons_init_screen(&sc->vd, &sc->sc_console_screen, 1,
282 1.1 macallan &defattr);
283 1.1 macallan sc->sc_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
284 1.1 macallan
285 1.1 macallan pm2fb_rectfill(sc, 0, 0, sc->sc_width, sc->sc_height,
286 1.1 macallan ri->ri_devcmap[(defattr >> 16) & 0xff]);
287 1.1 macallan sc->sc_defaultscreen_descr.textops = &ri->ri_ops;
288 1.1 macallan sc->sc_defaultscreen_descr.capabilities = ri->ri_caps;
289 1.1 macallan sc->sc_defaultscreen_descr.nrows = ri->ri_rows;
290 1.1 macallan sc->sc_defaultscreen_descr.ncols = ri->ri_cols;
291 1.1 macallan wsdisplay_cnattach(&sc->sc_defaultscreen_descr, ri, 0, 0,
292 1.1 macallan defattr);
293 1.1 macallan vcons_replay_msgbuf(&sc->sc_console_screen);
294 1.1 macallan } else {
295 1.1 macallan /*
296 1.1 macallan * since we're not the console we can postpone the rest
297 1.1 macallan * until someone actually allocates a screen for us
298 1.1 macallan */
299 1.1 macallan (*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
300 1.1 macallan }
301 1.1 macallan
302 1.1 macallan aa.console = is_console;
303 1.1 macallan aa.scrdata = &sc->sc_screenlist;
304 1.1 macallan aa.accessops = &pm2fb_accessops;
305 1.1 macallan aa.accesscookie = &sc->vd;
306 1.1 macallan
307 1.1 macallan config_found(sc->sc_dev, &aa, wsemuldisplaydevprint);
308 1.1 macallan
309 1.1 macallan printf("ap1 register: %08x\n", bus_space_read_4(sc->sc_memt,
310 1.1 macallan sc->sc_regh, PM2_APERTURE1_CONTROL));
311 1.1 macallan
312 1.1 macallan }
313 1.1 macallan
314 1.1 macallan static int
315 1.1 macallan pm2fb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag,
316 1.1 macallan struct lwp *l)
317 1.1 macallan {
318 1.1 macallan struct vcons_data *vd = v;
319 1.1 macallan struct pm2fb_softc *sc = vd->cookie;
320 1.1 macallan struct wsdisplay_fbinfo *wdf;
321 1.1 macallan struct vcons_screen *ms = vd->active;
322 1.1 macallan
323 1.1 macallan switch (cmd) {
324 1.1 macallan
325 1.1 macallan case WSDISPLAYIO_GTYPE:
326 1.1 macallan *(u_int *)data = WSDISPLAY_TYPE_PCIMISC;
327 1.1 macallan return 0;
328 1.1 macallan
329 1.1 macallan /* PCI config read/write passthrough. */
330 1.1 macallan case PCI_IOC_CFGREAD:
331 1.1 macallan case PCI_IOC_CFGWRITE:
332 1.1 macallan return (pci_devioctl(sc->sc_pc, sc->sc_pcitag,
333 1.1 macallan cmd, data, flag, l));
334 1.1 macallan
335 1.1 macallan case WSDISPLAYIO_GINFO:
336 1.1 macallan if (ms == NULL)
337 1.1 macallan return ENODEV;
338 1.1 macallan wdf = (void *)data;
339 1.1 macallan wdf->height = ms->scr_ri.ri_height;
340 1.1 macallan wdf->width = ms->scr_ri.ri_width;
341 1.1 macallan wdf->depth = ms->scr_ri.ri_depth;
342 1.1 macallan wdf->cmsize = 256;
343 1.1 macallan return 0;
344 1.1 macallan
345 1.1 macallan case WSDISPLAYIO_GETCMAP:
346 1.1 macallan return pm2fb_getcmap(sc,
347 1.1 macallan (struct wsdisplay_cmap *)data);
348 1.1 macallan
349 1.1 macallan case WSDISPLAYIO_PUTCMAP:
350 1.1 macallan return pm2fb_putcmap(sc,
351 1.1 macallan (struct wsdisplay_cmap *)data);
352 1.1 macallan
353 1.1 macallan case WSDISPLAYIO_LINEBYTES:
354 1.1 macallan *(u_int *)data = sc->sc_stride;
355 1.1 macallan return 0;
356 1.1 macallan
357 1.1 macallan case WSDISPLAYIO_SMODE:
358 1.1 macallan {
359 1.1 macallan int new_mode = *(int*)data;
360 1.1 macallan
361 1.1 macallan /* notify the bus backend */
362 1.1 macallan if (new_mode != sc->sc_mode) {
363 1.1 macallan sc->sc_mode = new_mode;
364 1.1 macallan if(new_mode == WSDISPLAYIO_MODE_EMUL) {
365 1.1 macallan pm2fb_restore_palette(sc);
366 1.1 macallan vcons_redraw_screen(ms);
367 1.1 macallan }
368 1.1 macallan }
369 1.1 macallan }
370 1.1 macallan return 0;
371 1.1 macallan }
372 1.1 macallan return EPASSTHROUGH;
373 1.1 macallan }
374 1.1 macallan
375 1.1 macallan static paddr_t
376 1.1 macallan pm2fb_mmap(void *v, void *vs, off_t offset, int prot)
377 1.1 macallan {
378 1.1 macallan struct vcons_data *vd = v;
379 1.1 macallan struct pm2fb_softc *sc = vd->cookie;
380 1.1 macallan paddr_t pa;
381 1.1 macallan
382 1.1 macallan /* 'regular' framebuffer mmap()ing */
383 1.1 macallan if (offset < sc->sc_fbsize) {
384 1.1 macallan pa = bus_space_mmap(sc->sc_memt, sc->sc_fb + offset, 0, prot,
385 1.1 macallan BUS_SPACE_MAP_LINEAR);
386 1.1 macallan return pa;
387 1.1 macallan }
388 1.1 macallan
389 1.1 macallan /*
390 1.1 macallan * restrict all other mappings to processes with superuser privileges
391 1.1 macallan * or the kernel itself
392 1.1 macallan */
393 1.1 macallan if (kauth_authorize_generic(kauth_cred_get(), KAUTH_GENERIC_ISSUSER,
394 1.1 macallan NULL) != 0) {
395 1.1 macallan aprint_normal("%s: mmap() rejected.\n",
396 1.1 macallan device_xname(sc->sc_dev));
397 1.1 macallan return -1;
398 1.1 macallan }
399 1.1 macallan
400 1.1 macallan if ((offset >= sc->sc_fb) && (offset < (sc->sc_fb + sc->sc_fbsize))) {
401 1.1 macallan pa = bus_space_mmap(sc->sc_memt, offset, 0, prot,
402 1.1 macallan BUS_SPACE_MAP_LINEAR);
403 1.1 macallan return pa;
404 1.1 macallan }
405 1.1 macallan
406 1.1 macallan if ((offset >= sc->sc_reg) &&
407 1.1 macallan (offset < (sc->sc_reg + sc->sc_regsize))) {
408 1.1 macallan pa = bus_space_mmap(sc->sc_memt, offset, 0, prot,
409 1.1 macallan BUS_SPACE_MAP_LINEAR);
410 1.1 macallan return pa;
411 1.1 macallan }
412 1.1 macallan
413 1.1 macallan #ifdef PCI_MAGIC_IO_RANGE
414 1.1 macallan /* allow mapping of IO space */
415 1.1 macallan if ((offset >= PCI_MAGIC_IO_RANGE) &&
416 1.1 macallan (offset < PCI_MAGIC_IO_RANGE + 0x10000)) {
417 1.1 macallan pa = bus_space_mmap(sc->sc_iot, offset - PCI_MAGIC_IO_RANGE,
418 1.1 macallan 0, prot, BUS_SPACE_MAP_LINEAR);
419 1.1 macallan return pa;
420 1.1 macallan }
421 1.1 macallan #endif
422 1.1 macallan
423 1.1 macallan #ifdef OFB_ALLOW_OTHERS
424 1.1 macallan if (offset >= 0x80000000) {
425 1.1 macallan pa = bus_space_mmap(sc->sc_memt, offset, 0, prot,
426 1.1 macallan BUS_SPACE_MAP_LINEAR);
427 1.1 macallan return pa;
428 1.1 macallan }
429 1.1 macallan #endif
430 1.1 macallan return -1;
431 1.1 macallan }
432 1.1 macallan
433 1.1 macallan static void
434 1.1 macallan pm2fb_init_screen(void *cookie, struct vcons_screen *scr,
435 1.1 macallan int existing, long *defattr)
436 1.1 macallan {
437 1.1 macallan struct pm2fb_softc *sc = cookie;
438 1.1 macallan struct rasops_info *ri = &scr->scr_ri;
439 1.1 macallan
440 1.1 macallan ri->ri_depth = sc->sc_depth;
441 1.1 macallan ri->ri_width = sc->sc_width;
442 1.1 macallan ri->ri_height = sc->sc_height;
443 1.1 macallan ri->ri_stride = sc->sc_stride;
444 1.1 macallan ri->ri_flg = RI_CENTER | RI_FULLCLEAR;
445 1.1 macallan
446 1.1 macallan ri->ri_bits = (char *)sc->sc_fbaddr;
447 1.1 macallan
448 1.1 macallan if (existing) {
449 1.1 macallan ri->ri_flg |= RI_CLEAR;
450 1.1 macallan }
451 1.1 macallan
452 1.1 macallan rasops_init(ri, sc->sc_height / 8, sc->sc_width / 8);
453 1.1 macallan ri->ri_caps = WSSCREEN_WSCOLORS;
454 1.1 macallan
455 1.1 macallan rasops_reconfig(ri, sc->sc_height / ri->ri_font->fontheight,
456 1.1 macallan sc->sc_width / ri->ri_font->fontwidth);
457 1.1 macallan
458 1.1 macallan ri->ri_hw = scr;
459 1.1 macallan ri->ri_ops.copyrows = pm2fb_copyrows;
460 1.1 macallan ri->ri_ops.copycols = pm2fb_copycols;
461 1.1 macallan ri->ri_ops.cursor = pm2fb_cursor;
462 1.1 macallan ri->ri_ops.eraserows = pm2fb_eraserows;
463 1.1 macallan ri->ri_ops.erasecols = pm2fb_erasecols;
464 1.1 macallan #if 0
465 1.1 macallan ri->ri_ops.putchar = pm2fb_putchar;
466 1.1 macallan #endif
467 1.1 macallan }
468 1.1 macallan
469 1.1 macallan static int
470 1.1 macallan pm2fb_putcmap(struct pm2fb_softc *sc, struct wsdisplay_cmap *cm)
471 1.1 macallan {
472 1.1 macallan u_char *r, *g, *b;
473 1.1 macallan u_int index = cm->index;
474 1.1 macallan u_int count = cm->count;
475 1.1 macallan int i, error;
476 1.1 macallan u_char rbuf[256], gbuf[256], bbuf[256];
477 1.1 macallan
478 1.1 macallan #ifdef PM2FB_DEBUG
479 1.1 macallan aprint_debug("putcmap: %d %d\n",index, count);
480 1.1 macallan #endif
481 1.1 macallan if (cm->index >= 256 || cm->count > 256 ||
482 1.1 macallan (cm->index + cm->count) > 256)
483 1.1 macallan return EINVAL;
484 1.1 macallan error = copyin(cm->red, &rbuf[index], count);
485 1.1 macallan if (error)
486 1.1 macallan return error;
487 1.1 macallan error = copyin(cm->green, &gbuf[index], count);
488 1.1 macallan if (error)
489 1.1 macallan return error;
490 1.1 macallan error = copyin(cm->blue, &bbuf[index], count);
491 1.1 macallan if (error)
492 1.1 macallan return error;
493 1.1 macallan
494 1.1 macallan memcpy(&sc->sc_cmap_red[index], &rbuf[index], count);
495 1.1 macallan memcpy(&sc->sc_cmap_green[index], &gbuf[index], count);
496 1.1 macallan memcpy(&sc->sc_cmap_blue[index], &bbuf[index], count);
497 1.1 macallan
498 1.1 macallan r = &sc->sc_cmap_red[index];
499 1.1 macallan g = &sc->sc_cmap_green[index];
500 1.1 macallan b = &sc->sc_cmap_blue[index];
501 1.1 macallan
502 1.1 macallan for (i = 0; i < count; i++) {
503 1.1 macallan pm2fb_putpalreg(sc, index, *r, *g, *b);
504 1.1 macallan index++;
505 1.1 macallan r++, g++, b++;
506 1.1 macallan }
507 1.1 macallan return 0;
508 1.1 macallan }
509 1.1 macallan
510 1.1 macallan static int
511 1.1 macallan pm2fb_getcmap(struct pm2fb_softc *sc, struct wsdisplay_cmap *cm)
512 1.1 macallan {
513 1.1 macallan u_int index = cm->index;
514 1.1 macallan u_int count = cm->count;
515 1.1 macallan int error;
516 1.1 macallan
517 1.1 macallan if (index >= 255 || count > 256 || index + count > 256)
518 1.1 macallan return EINVAL;
519 1.1 macallan
520 1.1 macallan error = copyout(&sc->sc_cmap_red[index], cm->red, count);
521 1.1 macallan if (error)
522 1.1 macallan return error;
523 1.1 macallan error = copyout(&sc->sc_cmap_green[index], cm->green, count);
524 1.1 macallan if (error)
525 1.1 macallan return error;
526 1.1 macallan error = copyout(&sc->sc_cmap_blue[index], cm->blue, count);
527 1.1 macallan if (error)
528 1.1 macallan return error;
529 1.1 macallan
530 1.1 macallan return 0;
531 1.1 macallan }
532 1.1 macallan
533 1.1 macallan static void
534 1.1 macallan pm2fb_restore_palette(struct pm2fb_softc *sc)
535 1.1 macallan {
536 1.1 macallan int i;
537 1.1 macallan
538 1.1 macallan for (i = 0; i < (1 << sc->sc_depth); i++) {
539 1.1 macallan pm2fb_putpalreg(sc, i, sc->sc_cmap_red[i],
540 1.1 macallan sc->sc_cmap_green[i], sc->sc_cmap_blue[i]);
541 1.1 macallan }
542 1.1 macallan }
543 1.1 macallan
544 1.1 macallan static int
545 1.1 macallan pm2fb_putpalreg(struct pm2fb_softc *sc, uint8_t idx, uint8_t r, uint8_t g,
546 1.1 macallan uint8_t b)
547 1.1 macallan {
548 1.1 macallan bus_space_write_1(sc->sc_memt, sc->sc_regh, PM2_DAC_PAL_WRITE_IDX, idx);
549 1.1 macallan bus_space_write_1(sc->sc_memt, sc->sc_regh, PM2_DAC_DATA, r);
550 1.1 macallan bus_space_write_1(sc->sc_memt, sc->sc_regh, PM2_DAC_DATA, g);
551 1.1 macallan bus_space_write_1(sc->sc_memt, sc->sc_regh, PM2_DAC_DATA, b);
552 1.1 macallan return 0;
553 1.1 macallan }
554 1.1 macallan
555 1.1 macallan static void
556 1.1 macallan pm2fb_init(struct pm2fb_softc *sc)
557 1.1 macallan {
558 1.1 macallan #if 0
559 1.1 macallan uint32_t datatype;
560 1.1 macallan #endif
561 1.1 macallan pm2fb_flush_engine(sc);
562 1.1 macallan
563 1.1 macallan pm2fb_wait(sc, 8);
564 1.1 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_SCREEN_BASE, 0);
565 1.1 macallan #if 0
566 1.1 macallan switch (sc->sc_depth) {
567 1.1 macallan case 8:
568 1.1 macallan datatype = R128_GMC_DST_8BPP_CI;
569 1.1 macallan break;
570 1.1 macallan case 15:
571 1.1 macallan datatype = R128_GMC_DST_15BPP;
572 1.1 macallan break;
573 1.1 macallan case 16:
574 1.1 macallan datatype = R128_GMC_DST_16BPP;
575 1.1 macallan break;
576 1.1 macallan case 24:
577 1.1 macallan datatype = R128_GMC_DST_24BPP;
578 1.1 macallan break;
579 1.1 macallan case 32:
580 1.1 macallan datatype = R128_GMC_DST_32BPP;
581 1.1 macallan break;
582 1.1 macallan default:
583 1.1 macallan aprint_error("%s: unsupported depth %d\n",
584 1.1 macallan device_xname(sc->sc_dev), sc->sc_depth);
585 1.1 macallan return;
586 1.1 macallan }
587 1.1 macallan sc->sc_master_cntl = R128_GMC_CLR_CMP_CNTL_DIS |
588 1.1 macallan R128_GMC_AUX_CLIP_DIS | datatype;
589 1.1 macallan #endif
590 1.1 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_BYPASS_MASK,
591 1.1 macallan 0xffffffff);
592 1.1 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_FB_WRITE_MASK,
593 1.1 macallan 0xffffffff);
594 1.1 macallan pm2fb_flush_engine(sc);
595 1.1 macallan }
596 1.1 macallan
597 1.1 macallan static void
598 1.1 macallan pm2fb_rectfill(struct pm2fb_softc *sc, int x, int y, int wi, int he,
599 1.1 macallan uint32_t colour)
600 1.1 macallan {
601 1.1 macallan
602 1.1 macallan pm2fb_wait(sc, 6);
603 1.2 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_RE_DDA_MODE,
604 1.2 macallan 0);
605 1.1 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_RE_CONFIG,
606 1.1 macallan PM2RECFG_WRITE_EN);
607 1.2 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_RE_BLOCK_COLOUR,
608 1.1 macallan colour);
609 1.1 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_RE_RECT_START,
610 1.1 macallan (y << 16) | x);
611 1.1 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_RE_RECT_SIZE,
612 1.1 macallan (he << 16) | wi);
613 1.1 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_RE_RENDER,
614 1.2 macallan PM2RE_RECTANGLE | PM2RE_INC_X | PM2RE_INC_Y | PM2RE_FASTFILL);
615 1.1 macallan
616 1.1 macallan pm2fb_flush_engine(sc);
617 1.1 macallan }
618 1.1 macallan
619 1.1 macallan static void
620 1.1 macallan pm2fb_bitblt(struct pm2fb_softc *sc, int xs, int ys, int xd, int yd,
621 1.1 macallan int wi, int he, int rop)
622 1.1 macallan {
623 1.1 macallan uint32_t dir = 0;
624 1.1 macallan
625 1.1 macallan if (yd <= ys) {
626 1.1 macallan dir |= PM2RE_INC_Y;
627 1.1 macallan }
628 1.1 macallan if (xd <= xs) {
629 1.1 macallan dir |= PM2RE_INC_X;
630 1.1 macallan }
631 1.2 macallan pm2fb_wait(sc, 6);
632 1.2 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_RE_DDA_MODE, 0);
633 1.1 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_RE_CONFIG,
634 1.1 macallan PM2RECFG_READ_SRC | PM2RECFG_WRITE_EN | PM2RECFG_ROP_EN |
635 1.1 macallan (rop << 6));
636 1.1 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_RE_RECT_START,
637 1.1 macallan (yd << 16) | xd);
638 1.1 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_RE_RECT_SIZE,
639 1.1 macallan (he << 16) | wi);
640 1.1 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_RE_SOURCE_DELTA,
641 1.1 macallan (((ys - yd) & 0xfff) << 16) | ((xs - xd) & 0xfff));
642 1.1 macallan bus_space_write_4(sc->sc_memt, sc->sc_regh, PM2_RE_RENDER,
643 1.1 macallan PM2RE_RECTANGLE | dir);
644 1.1 macallan pm2fb_flush_engine(sc);
645 1.1 macallan }
646 1.1 macallan
647 1.1 macallan static void
648 1.1 macallan pm2fb_cursor(void *cookie, int on, int row, int col)
649 1.1 macallan {
650 1.1 macallan struct rasops_info *ri = cookie;
651 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
652 1.1 macallan struct pm2fb_softc *sc = scr->scr_cookie;
653 1.1 macallan int x, y, wi, he;
654 1.1 macallan
655 1.1 macallan wi = ri->ri_font->fontwidth;
656 1.1 macallan he = ri->ri_font->fontheight;
657 1.1 macallan
658 1.1 macallan if (sc->sc_mode == WSDISPLAYIO_MODE_EMUL) {
659 1.1 macallan x = ri->ri_ccol * wi + ri->ri_xorigin;
660 1.1 macallan y = ri->ri_crow * he + ri->ri_yorigin;
661 1.1 macallan if (ri->ri_flg & RI_CURSOR) {
662 1.1 macallan pm2fb_bitblt(sc, x, y, x, y, wi, he, 12);
663 1.1 macallan ri->ri_flg &= ~RI_CURSOR;
664 1.1 macallan }
665 1.1 macallan ri->ri_crow = row;
666 1.1 macallan ri->ri_ccol = col;
667 1.1 macallan if (on) {
668 1.1 macallan x = ri->ri_ccol * wi + ri->ri_xorigin;
669 1.1 macallan y = ri->ri_crow * he + ri->ri_yorigin;
670 1.1 macallan pm2fb_bitblt(sc, x, y, x, y, wi, he, 12);
671 1.1 macallan ri->ri_flg |= RI_CURSOR;
672 1.1 macallan }
673 1.1 macallan } else {
674 1.1 macallan scr->scr_ri.ri_crow = row;
675 1.1 macallan scr->scr_ri.ri_ccol = col;
676 1.1 macallan scr->scr_ri.ri_flg &= ~RI_CURSOR;
677 1.1 macallan }
678 1.1 macallan
679 1.1 macallan }
680 1.1 macallan
681 1.1 macallan #if 0
682 1.1 macallan static void
683 1.1 macallan pm2fb_putchar(void *cookie, int row, int col, u_int c, long attr)
684 1.1 macallan {
685 1.1 macallan }
686 1.1 macallan #endif
687 1.1 macallan
688 1.1 macallan static void
689 1.1 macallan pm2fb_copycols(void *cookie, int row, int srccol, int dstcol, int ncols)
690 1.1 macallan {
691 1.1 macallan struct rasops_info *ri = cookie;
692 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
693 1.1 macallan struct pm2fb_softc *sc = scr->scr_cookie;
694 1.1 macallan int32_t xs, xd, y, width, height;
695 1.1 macallan
696 1.1 macallan if ((sc->sc_locked == 0) && (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)) {
697 1.1 macallan xs = ri->ri_xorigin + ri->ri_font->fontwidth * srccol;
698 1.1 macallan xd = ri->ri_xorigin + ri->ri_font->fontwidth * dstcol;
699 1.1 macallan y = ri->ri_yorigin + ri->ri_font->fontheight * row;
700 1.1 macallan width = ri->ri_font->fontwidth * ncols;
701 1.1 macallan height = ri->ri_font->fontheight;
702 1.1 macallan pm2fb_bitblt(sc, xs, y, xd, y, width, height, 3);
703 1.1 macallan }
704 1.1 macallan }
705 1.1 macallan
706 1.1 macallan static void
707 1.1 macallan pm2fb_erasecols(void *cookie, int row, int startcol, int ncols, long fillattr)
708 1.1 macallan {
709 1.1 macallan struct rasops_info *ri = cookie;
710 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
711 1.1 macallan struct pm2fb_softc *sc = scr->scr_cookie;
712 1.1 macallan int32_t x, y, width, height, fg, bg, ul;
713 1.1 macallan
714 1.1 macallan if ((sc->sc_locked == 0) && (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)) {
715 1.1 macallan x = ri->ri_xorigin + ri->ri_font->fontwidth * startcol;
716 1.1 macallan y = ri->ri_yorigin + ri->ri_font->fontheight * row;
717 1.1 macallan width = ri->ri_font->fontwidth * ncols;
718 1.1 macallan height = ri->ri_font->fontheight;
719 1.1 macallan rasops_unpack_attr(fillattr, &fg, &bg, &ul);
720 1.1 macallan
721 1.1 macallan pm2fb_rectfill(sc, x, y, width, height, ri->ri_devcmap[bg]);
722 1.1 macallan }
723 1.1 macallan }
724 1.1 macallan
725 1.1 macallan static void
726 1.1 macallan pm2fb_copyrows(void *cookie, int srcrow, int dstrow, int nrows)
727 1.1 macallan {
728 1.1 macallan struct rasops_info *ri = cookie;
729 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
730 1.1 macallan struct pm2fb_softc *sc = scr->scr_cookie;
731 1.1 macallan int32_t x, ys, yd, width, height;
732 1.1 macallan
733 1.1 macallan if ((sc->sc_locked == 0) && (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)) {
734 1.1 macallan x = ri->ri_xorigin;
735 1.1 macallan ys = ri->ri_yorigin + ri->ri_font->fontheight * srcrow;
736 1.1 macallan yd = ri->ri_yorigin + ri->ri_font->fontheight * dstrow;
737 1.1 macallan width = ri->ri_emuwidth;
738 1.1 macallan height = ri->ri_font->fontheight*nrows;
739 1.1 macallan pm2fb_bitblt(sc, x, ys, x, yd, width, height, 3);
740 1.1 macallan }
741 1.1 macallan }
742 1.1 macallan
743 1.1 macallan static void
744 1.1 macallan pm2fb_eraserows(void *cookie, int row, int nrows, long fillattr)
745 1.1 macallan {
746 1.1 macallan struct rasops_info *ri = cookie;
747 1.1 macallan struct vcons_screen *scr = ri->ri_hw;
748 1.1 macallan struct pm2fb_softc *sc = scr->scr_cookie;
749 1.1 macallan int32_t x, y, width, height, fg, bg, ul;
750 1.1 macallan
751 1.1 macallan if ((sc->sc_locked == 0) && (sc->sc_mode == WSDISPLAYIO_MODE_EMUL)) {
752 1.1 macallan x = ri->ri_xorigin;
753 1.1 macallan y = ri->ri_yorigin + ri->ri_font->fontheight * row;
754 1.1 macallan width = ri->ri_emuwidth;
755 1.1 macallan height = ri->ri_font->fontheight * nrows;
756 1.1 macallan rasops_unpack_attr(fillattr, &fg, &bg, &ul);
757 1.1 macallan
758 1.1 macallan pm2fb_rectfill(sc, x, y, width, height, ri->ri_devcmap[bg]);
759 1.1 macallan }
760 1.1 macallan }
761 1.1 macallan
762