crmfb.c revision 1.21 1 /* $NetBSD: crmfb.c,v 1.21 2008/03/01 16:56:39 macallan Exp $ */
2
3 /*-
4 * Copyright (c) 2007 Jared D. McNeill <jmcneill (at) invisible.ca>
5 * 2008 Michael Lorenz <macallan (at) netbsd.org>
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. All advertising materials mentioning features or use of this software
17 * must display the following acknowledgement:
18 * This product includes software developed by Jared D. McNeill.
19 * 4. Neither the name of The NetBSD Foundation nor the names of its
20 * contributors may be used to endorse or promote products derived
21 * from this software without specific prior written permission.
22 *
23 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
24 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
25 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
26 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
27 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
28 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
29 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
30 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
31 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
32 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
33 * POSSIBILITY OF SUCH DAMAGE.
34 */
35
36 /*
37 * SGI-CRM (O2) Framebuffer driver
38 */
39
40 #include <sys/cdefs.h>
41 __KERNEL_RCSID(0, "$NetBSD: crmfb.c,v 1.21 2008/03/01 16:56:39 macallan Exp $");
42
43 #include <sys/param.h>
44 #include <sys/systm.h>
45 #include <sys/device.h>
46 #include <sys/malloc.h>
47
48 #define _SGIMIPS_BUS_DMA_PRIVATE
49 #include <machine/autoconf.h>
50 #include <machine/bus.h>
51 #include <machine/machtype.h>
52 #include <machine/vmparam.h>
53
54 #include <dev/arcbios/arcbios.h>
55 #include <dev/arcbios/arcbiosvar.h>
56
57 #include <dev/wscons/wsdisplayvar.h>
58 #include <dev/wscons/wsconsio.h>
59 #include <dev/wsfont/wsfont.h>
60 #include <dev/rasops/rasops.h>
61 #include <dev/wscons/wsdisplay_vconsvar.h>
62
63 #include <arch/sgimips/dev/crmfbreg.h>
64
65 /*#define CRMFB_DEBUG*/
66
67 struct wsscreen_descr crmfb_defaultscreen = {
68 "default",
69 0, 0,
70 NULL,
71 8, 16,
72 WSSCREEN_WSCOLORS,
73 NULL,
74 };
75
76 const struct wsscreen_descr *_crmfb_scrlist[] = {
77 &crmfb_defaultscreen,
78 };
79
80 struct wsscreen_list crmfb_screenlist = {
81 sizeof(_crmfb_scrlist) / sizeof(struct wsscreen_descr *),
82 _crmfb_scrlist
83 };
84
85 static struct vcons_screen crmfb_console_screen;
86
87 static int crmfb_ioctl(void *, void *, u_long, void *, int, struct lwp *);
88 static paddr_t crmfb_mmap(void *, void *, off_t, int);
89 static void crmfb_init_screen(void *, struct vcons_screen *, int, long *);
90
91 struct wsdisplay_accessops crmfb_accessops = {
92 crmfb_ioctl,
93 crmfb_mmap,
94 NULL, /* alloc_screen */
95 NULL, /* free_screen */
96 NULL, /* show_screen */
97 NULL, /* load_font */
98 NULL, /* pollc */
99 NULL, /* scroll */
100 };
101
102 /* Memory to allocate to SGI-CRM -- remember, this is stolen from
103 * host memory!
104 */
105 #define CRMFB_TILESIZE (512*128)
106
107 static int crmfb_match(struct device *, struct cfdata *, void *);
108 static void crmfb_attach(struct device *, struct device *, void *);
109 int crmfb_probe(void);
110
111 #define KERNADDR(p) ((void *)((p).addr))
112 #define DMAADDR(p) ((p).map->dm_segs[0].ds_addr)
113
114 #define CRMFB_REG_MASK(msb, lsb) \
115 ( (((uint32_t) 1 << ((msb)-(lsb)+1)) - 1) << (lsb) )
116
117
118 struct crmfb_dma {
119 bus_dmamap_t map;
120 void *addr;
121 bus_dma_segment_t segs[1];
122 int nsegs;
123 size_t size;
124 };
125
126 struct crmfb_softc {
127 struct device sc_dev;
128 struct vcons_data sc_vd;
129
130 bus_space_tag_t sc_iot;
131 bus_space_handle_t sc_ioh;
132 bus_space_handle_t sc_reh;
133
134 bus_dma_tag_t sc_dmat;
135
136 struct crmfb_dma sc_dma;
137 struct crmfb_dma sc_dmai;
138
139 int sc_width;
140 int sc_height;
141 int sc_depth;
142 int sc_tiles_x, sc_tiles_y;
143 uint32_t sc_fbsize;
144 int sc_mte_direction;
145 uint8_t *sc_scratch;
146 paddr_t sc_linear;
147 struct rasops_info sc_rasops;
148 int sc_cells;
149 int sc_current_cell;
150 int sc_wsmode;
151
152 /* cursor stuff */
153 int sc_cur_x;
154 int sc_cur_y;
155 int sc_hot_x;
156 int sc_hot_y;
157
158 u_char sc_cmap_red[256];
159 u_char sc_cmap_green[256];
160 u_char sc_cmap_blue[256];
161 };
162
163 static int crmfb_putcmap(struct crmfb_softc *, struct wsdisplay_cmap *);
164 static int crmfb_getcmap(struct crmfb_softc *, struct wsdisplay_cmap *);
165 static void crmfb_set_palette(struct crmfb_softc *,
166 int, uint8_t, uint8_t, uint8_t);
167 static int crmfb_set_curpos(struct crmfb_softc *, int, int);
168 static int crmfb_gcursor(struct crmfb_softc *, struct wsdisplay_cursor *);
169 static int crmfb_scursor(struct crmfb_softc *, struct wsdisplay_cursor *);
170 static inline void crmfb_write_reg(struct crmfb_softc *, int, uint32_t);
171 static inline uint32_t crmfb_read_reg(struct crmfb_softc *, int);
172 static int crmfb_wait_dma_idle(struct crmfb_softc *);
173
174 /* setup video hw in given colour depth */
175 static int crmfb_setup_video(struct crmfb_softc *, int);
176 static void crmfb_setup_palette(struct crmfb_softc *);
177
178 #ifdef CRMFB_DEBUG
179 void crmfb_test_mte(struct crmfb_softc *);
180 #endif
181
182 static void crmfb_fill_rect(struct crmfb_softc *, int, int, int, int, uint32_t);
183 static void crmfb_bitblt(struct crmfb_softc *, int, int, int, int, int, int,
184 uint32_t);
185 static void crmfb_scroll(struct crmfb_softc *, int, int, int, int, int, int);
186
187 static void crmfb_copycols(void *, int, int, int, int);
188 static void crmfb_erasecols(void *, int, int, int, long);
189 static void crmfb_copyrows(void *, int, int, int);
190 static void crmfb_eraserows(void *, int, int, long);
191 static void crmfb_cursor(void *, int, int, int);
192 static void crmfb_putchar(void *, int, int, u_int, long);
193
194 CFATTACH_DECL(crmfb, sizeof(struct crmfb_softc),
195 crmfb_match, crmfb_attach, NULL, NULL);
196
197 static int
198 crmfb_match(struct device *parent, struct cfdata *cf, void *opaque)
199 {
200 return crmfb_probe();
201 }
202
203 static void
204 crmfb_attach(struct device *parent, struct device *self, void *opaque)
205 {
206 struct mainbus_attach_args *ma;
207 struct crmfb_softc *sc;
208 struct rasops_info *ri;
209 struct wsemuldisplaydev_attach_args aa;
210 uint32_t d, h;
211 uint16_t *p;
212 unsigned long v;
213 long defattr;
214 const char *consdev;
215 int rv, i;
216
217 sc = (struct crmfb_softc *)self;
218 ma = (struct mainbus_attach_args *)opaque;
219
220 sc->sc_iot = SGIMIPS_BUS_SPACE_CRIME;
221 sc->sc_dmat = &sgimips_default_bus_dma_tag;
222 sc->sc_wsmode = WSDISPLAYIO_MODE_EMUL;
223
224 aprint_normal(": SGI CRIME Graphics Display Engine\n");
225 rv = bus_space_map(sc->sc_iot, ma->ma_addr, 0 /* XXX */,
226 BUS_SPACE_MAP_LINEAR, &sc->sc_ioh);
227 if (rv)
228 panic("crmfb_attach: can't map I/O space");
229 rv = bus_space_map(sc->sc_iot, 0x15000000, 0x6000, 0, &sc->sc_reh);
230 if (rv)
231 panic("crmfb_attach: can't map rendering engine");
232
233 /* determine mode configured by firmware */
234 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_VT_HCMAP);
235 sc->sc_width = (d >> CRMFB_VT_HCMAP_ON_SHIFT) & 0xfff;
236 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_VT_VCMAP);
237 sc->sc_height = (d >> CRMFB_VT_VCMAP_ON_SHIFT) & 0xfff;
238 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_FRM_TILESIZE);
239 h = (d >> CRMFB_FRM_TILESIZE_DEPTH_SHIFT) & 0x3;
240 if (h == 0)
241 sc->sc_depth = 8;
242 else if (h == 1)
243 sc->sc_depth = 16;
244 else
245 sc->sc_depth = 32;
246
247 if (sc->sc_width == 0 || sc->sc_height == 0) {
248 aprint_error("%s: device unusable if not setup by firmware\n",
249 sc->sc_dev.dv_xname);
250 bus_space_unmap(sc->sc_iot, sc->sc_ioh, 0 /* XXX */);
251 return;
252 }
253
254 aprint_normal("%s: initial resolution %dx%d\n",
255 sc->sc_dev.dv_xname, sc->sc_width, sc->sc_height);
256
257 /*
258 * first determine how many tiles we need
259 * in 32bit each tile is 128x128 pixels
260 */
261 sc->sc_tiles_x = (sc->sc_width + 127) >> 7;
262 sc->sc_tiles_y = (sc->sc_height + 127) >> 7;
263 sc->sc_fbsize = 0x10000 * sc->sc_tiles_x * sc->sc_tiles_y;
264 aprint_normal("so we need %d x %d tiles -> %08x\n", sc->sc_tiles_x,
265 sc->sc_tiles_y, sc->sc_fbsize);
266
267 sc->sc_dmai.size = 256 * sizeof(uint16_t);
268 rv = bus_dmamem_alloc(sc->sc_dmat, sc->sc_dmai.size, 65536, 0,
269 sc->sc_dmai.segs,
270 sizeof(sc->sc_dmai.segs) / sizeof(sc->sc_dmai.segs[0]),
271 &sc->sc_dmai.nsegs, BUS_DMA_NOWAIT);
272 if (rv)
273 panic("crmfb_attach: can't allocate DMA memory");
274 rv = bus_dmamem_map(sc->sc_dmat, sc->sc_dmai.segs, sc->sc_dmai.nsegs,
275 sc->sc_dmai.size, &sc->sc_dmai.addr,
276 BUS_DMA_NOWAIT);
277 if (rv)
278 panic("crmfb_attach: can't map DMA memory");
279 rv = bus_dmamap_create(sc->sc_dmat, sc->sc_dmai.size, 1,
280 sc->sc_dmai.size, 0, BUS_DMA_NOWAIT, &sc->sc_dmai.map);
281 if (rv)
282 panic("crmfb_attach: can't create DMA map");
283 rv = bus_dmamap_load(sc->sc_dmat, sc->sc_dmai.map, sc->sc_dmai.addr,
284 sc->sc_dmai.size, NULL, BUS_DMA_NOWAIT);
285 if (rv)
286 panic("crmfb_attach: can't load DMA map");
287
288 /* allocate an extra 64Kb for a linear buffer */
289 sc->sc_dma.size = 0x10000 * (16 * sc->sc_tiles_x + 1);
290 rv = bus_dmamem_alloc(sc->sc_dmat, sc->sc_dma.size, 65536, 0,
291 sc->sc_dma.segs,
292 sizeof(sc->sc_dma.segs) / sizeof(sc->sc_dma.segs[0]),
293 &sc->sc_dma.nsegs, BUS_DMA_NOWAIT);
294 if (rv)
295 panic("crmfb_attach: can't allocate DMA memory");
296 rv = bus_dmamem_map(sc->sc_dmat, sc->sc_dma.segs, sc->sc_dma.nsegs,
297 sc->sc_dma.size, &sc->sc_dma.addr,
298 BUS_DMA_NOWAIT | BUS_DMA_COHERENT);
299 if (rv)
300 panic("crmfb_attach: can't map DMA memory");
301 rv = bus_dmamap_create(sc->sc_dmat, sc->sc_dma.size, 1,
302 sc->sc_dma.size, 0, BUS_DMA_NOWAIT, &sc->sc_dma.map);
303 if (rv)
304 panic("crmfb_attach: can't create DMA map");
305 rv = bus_dmamap_load(sc->sc_dmat, sc->sc_dma.map, sc->sc_dma.addr,
306 sc->sc_dma.size, NULL, BUS_DMA_NOWAIT);
307 if (rv)
308 panic("crmfb_attach: can't load DMA map");
309
310 p = KERNADDR(sc->sc_dmai);
311 v = (unsigned long)DMAADDR(sc->sc_dma);
312 for (i = 0; i < (sc->sc_tiles_x * sc->sc_tiles_y); i++) {
313 p[i] = ((uint32_t)v >> 16) + i;
314 }
315 sc->sc_scratch = (char *)KERNADDR(sc->sc_dma) + (0xf0000 * sc->sc_tiles_x);
316 sc->sc_linear = (paddr_t)DMAADDR(sc->sc_dma) + 0x100000 * sc->sc_tiles_x;
317
318 aprint_normal("%s: allocated %d byte fb @ %p (%p)\n",
319 sc->sc_dev.dv_xname,
320 sc->sc_fbsize, KERNADDR(sc->sc_dmai), KERNADDR(sc->sc_dma));
321
322 sc->sc_current_cell = 0;
323
324 crmfb_setup_video(sc, 8);
325 ri = &crmfb_console_screen.scr_ri;
326 memset(ri, 0, sizeof(struct rasops_info));
327
328 vcons_init(&sc->sc_vd, sc, &crmfb_defaultscreen, &crmfb_accessops);
329 sc->sc_vd.init_screen = crmfb_init_screen;
330 crmfb_console_screen.scr_flags |= VCONS_SCREEN_IS_STATIC;
331 vcons_init_screen(&sc->sc_vd, &crmfb_console_screen, 1, &defattr);
332
333 crmfb_defaultscreen.ncols = ri->ri_cols;
334 crmfb_defaultscreen.nrows = ri->ri_rows;
335 crmfb_defaultscreen.textops = &ri->ri_ops;
336 crmfb_defaultscreen.capabilities = ri->ri_caps;
337 crmfb_defaultscreen.modecookie = NULL;
338
339 crmfb_setup_palette(sc);
340 crmfb_fill_rect(sc, 0, 0, sc->sc_width, sc->sc_height,
341 ri->ri_devcmap[(defattr >> 16) & 0xff]);
342
343 consdev = ARCBIOS->GetEnvironmentVariable("ConsoleOut");
344 if (consdev != NULL && strcmp(consdev, "video()") == 0) {
345 wsdisplay_cnattach(&crmfb_defaultscreen, ri, 0, 0, defattr);
346 aa.console = 1;
347 } else
348 aa.console = 0;
349 aa.scrdata = &crmfb_screenlist;
350 aa.accessops = &crmfb_accessops;
351 aa.accesscookie = &sc->sc_vd;
352
353 config_found(self, &aa, wsemuldisplaydevprint);
354
355 sc->sc_cur_x = 0;
356 sc->sc_cur_y = 0;
357 sc->sc_hot_x = 0;
358 sc->sc_hot_y = 0;
359
360 #ifdef CRMFB_DEBUG
361 crmfb_test_mte(sc);
362 #endif
363 return;
364 }
365
366 int
367 crmfb_probe(void)
368 {
369
370 if (mach_type != MACH_SGI_IP32)
371 return 0;
372
373 return 1;
374 }
375
376 static int
377 crmfb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l)
378 {
379 struct vcons_data *vd;
380 struct crmfb_softc *sc;
381 struct vcons_screen *ms;
382 struct wsdisplay_fbinfo *wdf;
383 int nmode;
384
385 vd = (struct vcons_data *)v;
386 sc = (struct crmfb_softc *)vd->cookie;
387 ms = (struct vcons_screen *)vd->active;
388
389 switch (cmd) {
390 case WSDISPLAYIO_GTYPE:
391 /* not really, but who cares? */
392 /* wsfb does */
393 *(u_int *)data = WSDISPLAY_TYPE_CRIME;
394 return 0;
395 case WSDISPLAYIO_GINFO:
396 if (vd->active != NULL) {
397 wdf = (void *)data;
398 wdf->height = sc->sc_height;
399 wdf->width = sc->sc_width;
400 wdf->depth = 32;
401 wdf->cmsize = 256;
402 return 0;
403 } else
404 return ENODEV;
405 case WSDISPLAYIO_GETCMAP:
406 if (sc->sc_depth == 8)
407 return crmfb_getcmap(sc, (struct wsdisplay_cmap *)data);
408 else
409 return EINVAL;
410 case WSDISPLAYIO_PUTCMAP:
411 if (sc->sc_depth == 8)
412 return crmfb_putcmap(sc, (struct wsdisplay_cmap *)data);
413 else
414 return EINVAL;
415 case WSDISPLAYIO_LINEBYTES:
416 *(u_int *)data = sc->sc_width * sc->sc_depth / 8;
417 return 0;
418 case WSDISPLAYIO_SMODE:
419 nmode = *(int *)data;
420 if (nmode != sc->sc_wsmode) {
421 sc->sc_wsmode = nmode;
422 if (nmode == WSDISPLAYIO_MODE_EMUL) {
423 crmfb_setup_video(sc, 8);
424 crmfb_setup_palette(sc);
425 vcons_redraw_screen(vd->active);
426 } else {
427 crmfb_setup_video(sc, 32);
428 }
429 }
430 return 0;
431 case WSDISPLAYIO_SVIDEO:
432 case WSDISPLAYIO_GVIDEO:
433 return ENODEV; /* not supported yet */
434
435 case WSDISPLAYIO_GCURPOS:
436 {
437 struct wsdisplay_curpos *pos;
438
439 pos = (struct wsdisplay_curpos *)data;
440 pos->x = sc->sc_cur_x;
441 pos->y = sc->sc_cur_y;
442 }
443 return 0;
444 case WSDISPLAYIO_SCURPOS:
445 {
446 struct wsdisplay_curpos *pos;
447
448 pos = (struct wsdisplay_curpos *)data;
449 crmfb_set_curpos(sc, pos->x, pos->y);
450 }
451 return 0;
452 case WSDISPLAYIO_GCURMAX:
453 {
454 struct wsdisplay_curpos *pos;
455
456 pos = (struct wsdisplay_curpos *)data;
457 pos->x = 32;
458 pos->y = 32;
459 }
460 return 0;
461 case WSDISPLAYIO_GCURSOR:
462 {
463 struct wsdisplay_cursor *cu;
464
465 cu = (struct wsdisplay_cursor *)data;
466 return crmfb_gcursor(sc, cu);
467 }
468 case WSDISPLAYIO_SCURSOR:
469 {
470 struct wsdisplay_cursor *cu;
471
472 cu = (struct wsdisplay_cursor *)data;
473 return crmfb_scursor(sc, cu);
474 }
475 }
476 return EPASSTHROUGH;
477 }
478
479 static paddr_t
480 crmfb_mmap(void *v, void *vs, off_t offset, int prot)
481 {
482 struct vcons_data *vd;
483 struct crmfb_softc *sc;
484 paddr_t pa;
485
486 vd = (struct vcons_data *)v;
487 sc = (struct crmfb_softc *)vd->cookie;
488
489 /* we probably shouldn't let anyone mmap the framebuffer */
490 #if 1
491 if (offset >= 0 && offset < sc->sc_fbsize) {
492 pa = bus_dmamem_mmap(sc->sc_dmat, sc->sc_dma.segs,
493 sc->sc_dma.nsegs, offset, prot,
494 BUS_DMA_WAITOK | BUS_DMA_COHERENT);
495 return pa;
496 }
497 #endif
498 /*
499 * here would the TLBs be but we don't want to show them to userland
500 * so we return the page containing the status register
501 */
502 if ((offset >= 0x15000000) && (offset < 0x15002000))
503 return bus_space_mmap(sc->sc_iot, 0x15004000, 0, prot, 0);
504 /* now the actual engine registers */
505 if ((offset >= 0x15002000) && (offset < 0x15005000))
506 return bus_space_mmap(sc->sc_iot, offset, 0, prot, 0);
507 /* and now the scratch area */
508 if ((offset >= 0x15010000) && (offset < 0x15020000))
509 return bus_dmamem_mmap(sc->sc_dmat, sc->sc_dma.segs,
510 sc->sc_dma.nsegs,
511 offset + (0x100000 * sc->sc_tiles_x) - 0x15010000,
512 prot, BUS_DMA_WAITOK | BUS_DMA_COHERENT);
513 return -1;
514 }
515
516 static void
517 crmfb_init_screen(void *c, struct vcons_screen *scr, int existing,
518 long *defattr)
519 {
520 struct crmfb_softc *sc;
521 struct rasops_info *ri;
522
523 sc = (struct crmfb_softc *)c;
524 ri = &scr->scr_ri;
525
526 ri->ri_flg = RI_CENTER | RI_FULLCLEAR;
527 ri->ri_depth = sc->sc_depth;
528 ri->ri_width = sc->sc_width;
529 ri->ri_height = sc->sc_height;
530 ri->ri_stride = ri->ri_width * (ri->ri_depth / 8);
531
532 switch (ri->ri_depth) {
533 case 16:
534 ri->ri_rnum = ri->ri_gnum = ri->ri_bnum = 5;
535 ri->ri_rpos = 10;
536 ri->ri_gpos = 5;
537 ri->ri_bpos = 0;
538 break;
539 case 32:
540 ri->ri_rnum = ri->ri_gnum = ri->ri_bnum = 8;
541 ri->ri_rpos = 8;
542 ri->ri_gpos = 16;
543 ri->ri_bpos = 24;
544 break;
545 }
546
547 ri->ri_bits = KERNADDR(sc->sc_dma);
548
549 if (existing)
550 ri->ri_flg |= RI_CLEAR;
551
552 rasops_init(ri, ri->ri_height / 16, ri->ri_width / 8);
553 ri->ri_caps = WSSCREEN_WSCOLORS;
554 rasops_reconfig(ri, ri->ri_height / ri->ri_font->fontheight,
555 ri->ri_width / ri->ri_font->fontwidth);
556 ri->ri_hw = scr;
557
558 /* now make a fake rasops_info for drawing into the scratch tile */
559 memcpy(&sc->sc_rasops, ri, sizeof(struct rasops_info));
560 sc->sc_rasops.ri_width = 512; /* assume we're always in 8bit here */
561 sc->sc_rasops.ri_stride = 512;
562 sc->sc_rasops.ri_height = 128;
563 sc->sc_rasops.ri_xorigin = 0;
564 sc->sc_rasops.ri_yorigin = 0;
565 sc->sc_rasops.ri_bits = sc->sc_scratch;
566 sc->sc_cells = 512 / ri->ri_font->fontwidth;
567
568 ri->ri_ops.cursor = crmfb_cursor;
569 ri->ri_ops.copyrows = crmfb_copyrows;
570 ri->ri_ops.eraserows = crmfb_eraserows;
571 ri->ri_ops.copycols = crmfb_copycols;
572 ri->ri_ops.erasecols = crmfb_erasecols;
573 ri->ri_ops.putchar = crmfb_putchar;
574
575 return;
576 }
577
578 static int
579 crmfb_putcmap(struct crmfb_softc *sc, struct wsdisplay_cmap *cm)
580 {
581 u_int idx, cnt;
582 u_char r[256], g[256], b[256];
583 u_char *rp, *gp, *bp;
584 int rv, i;
585
586 idx = cm->index;
587 cnt = cm->count;
588
589 if (idx >= 255 || cnt > 256 || idx + cnt > 256)
590 return EINVAL;
591
592 rv = copyin(cm->red, &r[idx], cnt);
593 if (rv)
594 return rv;
595 rv = copyin(cm->green, &g[idx], cnt);
596 if (rv)
597 return rv;
598 rv = copyin(cm->blue, &b[idx], cnt);
599 if (rv)
600 return rv;
601
602 memcpy(&sc->sc_cmap_red[idx], &r[idx], cnt);
603 memcpy(&sc->sc_cmap_green[idx], &g[idx], cnt);
604 memcpy(&sc->sc_cmap_blue[idx], &b[idx], cnt);
605
606 rp = &sc->sc_cmap_red[idx];
607 gp = &sc->sc_cmap_green[idx];
608 bp = &sc->sc_cmap_blue[idx];
609
610 for (i = 0; i < cnt; i++) {
611 crmfb_set_palette(sc, idx, *rp, *gp, *bp);
612 idx++;
613 rp++, gp++, bp++;
614 }
615
616 return 0;
617 }
618
619 static int
620 crmfb_getcmap(struct crmfb_softc *sc, struct wsdisplay_cmap *cm)
621 {
622 u_int idx, cnt;
623 int rv;
624
625 idx = cm->index;
626 cnt = cm->count;
627
628 if (idx >= 255 || cnt > 256 || idx + cnt > 256)
629 return EINVAL;
630
631 rv = copyout(&sc->sc_cmap_red[idx], cm->red, cnt);
632 if (rv)
633 return rv;
634 rv = copyout(&sc->sc_cmap_green[idx], cm->green, cnt);
635 if (rv)
636 return rv;
637 rv = copyout(&sc->sc_cmap_blue[idx], cm->blue, cnt);
638 if (rv)
639 return rv;
640
641 return 0;
642 }
643
644 static void
645 crmfb_set_palette(struct crmfb_softc *sc, int reg, uint8_t r, uint8_t g,
646 uint8_t b)
647 {
648 uint32_t val;
649
650 if (reg > 255 || sc->sc_depth != 8)
651 return;
652
653 while (bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_CMAP_FIFO) >= 63)
654 DELAY(10);
655
656 val = (r << 24) | (g << 16) | (b << 8);
657 crmfb_write_reg(sc, CRMFB_CMAP + (reg * 4), val);
658
659 return;
660 }
661
662 static int
663 crmfb_set_curpos(struct crmfb_softc *sc, int x, int y)
664 {
665 uint32_t val;
666
667 sc->sc_cur_x = x;
668 sc->sc_cur_y = y;
669
670 val = ((x - sc->sc_hot_x) & 0xffff) | ((y - sc->sc_hot_y) << 16);
671 crmfb_write_reg(sc, CRMFB_CURSOR_POS, val);
672
673 return 0;
674 }
675
676 static int
677 crmfb_gcursor(struct crmfb_softc *sc, struct wsdisplay_cursor *cur)
678 {
679 /* do nothing for now */
680 return 0;
681 }
682
683 static int
684 crmfb_scursor(struct crmfb_softc *sc, struct wsdisplay_cursor *cur)
685 {
686 if (cur->which & WSDISPLAY_CURSOR_DOCUR) {
687
688 crmfb_write_reg(sc, CRMFB_CURSOR_CONTROL, cur->enable ? 1 : 0);
689 }
690 if (cur->which & WSDISPLAY_CURSOR_DOHOT) {
691
692 sc->sc_hot_x = cur->hot.x;
693 sc->sc_hot_y = cur->hot.y;
694 }
695 if (cur->which & WSDISPLAY_CURSOR_DOPOS) {
696
697 crmfb_set_curpos(sc, cur->pos.x, cur->pos.y);
698 }
699 if (cur->which & WSDISPLAY_CURSOR_DOCMAP) {
700 int i;
701 uint32_t val;
702
703 for (i = 0; i < cur->cmap.count; i++) {
704 val = (cur->cmap.red[i] << 24) |
705 (cur->cmap.green[i] << 16) |
706 (cur->cmap.blue[i] << 8);
707 crmfb_write_reg(sc, CRMFB_CURSOR_CMAP0 +
708 ((i + cur->cmap.index) << 2), val);
709 }
710 }
711 if (cur->which & WSDISPLAY_CURSOR_DOSHAPE) {
712
713 int i, j, cnt = 0;
714 uint32_t latch = 0, omask;
715 uint8_t imask;
716 for (i = 0; i < 64; i++) {
717 omask = 0x80000000;
718 imask = 0x01;
719 cur->image[cnt] &= cur->mask[cnt];
720 for (j = 0; j < 8; j++) {
721 if (cur->image[cnt] & imask)
722 latch |= omask;
723 omask >>= 1;
724 if (cur->mask[cnt] & imask)
725 latch |= omask;
726 omask >>= 1;
727 imask <<= 1;
728 }
729 cnt++;
730 imask = 0x01;
731 cur->image[cnt] &= cur->mask[cnt];
732 for (j = 0; j < 8; j++) {
733 if (cur->image[cnt] & imask)
734 latch |= omask;
735 omask >>= 1;
736 if (cur->mask[cnt] & imask)
737 latch |= omask;
738 omask >>= 1;
739 imask <<= 1;
740 }
741 cnt++;
742 crmfb_write_reg(sc, CRMFB_CURSOR_BITMAP + (i << 2),
743 latch);
744 latch = 0;
745 }
746 }
747 return 0;
748 }
749
750 static inline void
751 crmfb_write_reg(struct crmfb_softc *sc, int offset, uint32_t val)
752 {
753
754 bus_space_write_4(sc->sc_iot, sc->sc_ioh, offset, val);
755 wbflush();
756 }
757
758 static inline uint32_t
759 crmfb_read_reg(struct crmfb_softc *sc, int offset)
760 {
761
762 return bus_space_read_4(sc->sc_iot, sc->sc_ioh, offset);
763 }
764
765 static int
766 crmfb_wait_dma_idle(struct crmfb_softc *sc)
767 {
768 int bail = 100000, idle;
769
770 do {
771 idle = ((bus_space_read_4(sc->sc_iot, sc->sc_ioh,
772 CRMFB_OVR_CONTROL) & 1) == 0) &&
773 ((bus_space_read_4(sc->sc_iot, sc->sc_ioh,
774 CRMFB_FRM_CONTROL) & 1) == 0) &&
775 ((bus_space_read_4(sc->sc_iot, sc->sc_ioh,
776 CRMFB_DID_CONTROL) & 1) == 0);
777 if (!idle)
778 delay(10);
779 bail--;
780 } while ((!idle) && (bail > 0));
781 return idle;
782 }
783
784 static int
785 crmfb_setup_video(struct crmfb_softc *sc, int depth)
786 {
787 uint64_t reg;
788 uint32_t d, h, mode, page;
789 int i, bail, tile_width, tlbptr, lptr, j, tx, shift;
790 const char *wantsync;
791 uint16_t v;
792
793 /* disable DMA */
794 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_OVR_CONTROL);
795 d &= ~(1 << CRMFB_OVR_CONTROL_DMAEN_SHIFT);
796 crmfb_write_reg(sc, CRMFB_OVR_CONTROL, d);
797 DELAY(50000);
798 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_FRM_CONTROL);
799 d &= ~(1 << CRMFB_FRM_CONTROL_DMAEN_SHIFT);
800 crmfb_write_reg(sc, CRMFB_FRM_CONTROL, d);
801 DELAY(50000);
802 crmfb_write_reg(sc, CRMFB_DID_CONTROL, 0);
803 DELAY(50000);
804
805 if (!crmfb_wait_dma_idle(sc))
806 aprint_error("crmfb: crmfb_wait_dma_idle timed out\n");
807
808 /* ensure that CRM starts drawing at the top left of the screen
809 * when we re-enable DMA later
810 */
811 d = (1 << CRMFB_VT_XY_FREEZE_SHIFT);
812 crmfb_write_reg(sc, CRMFB_VT_XY, d);
813 delay(1000);
814 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_DOTCLOCK);
815 d &= ~(1 << CRMFB_DOTCLOCK_CLKRUN_SHIFT);
816 crmfb_write_reg(sc, CRMFB_DOTCLOCK, d);
817
818 /* wait for dotclock to turn off */
819 bail = 10000;
820 while ((bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_DOTCLOCK) &
821 (1 << CRMFB_DOTCLOCK_CLKRUN_SHIFT)) && (bail > 0)) {
822 delay(10);
823 bail--;
824 }
825
826 /* reset FIFO */
827 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_FRM_TILESIZE);
828 d |= (1 << CRMFB_FRM_TILESIZE_FIFOR_SHIFT);
829 crmfb_write_reg(sc, CRMFB_FRM_TILESIZE, d);
830 d &= ~(1 << CRMFB_FRM_TILESIZE_FIFOR_SHIFT);
831 crmfb_write_reg(sc, CRMFB_FRM_TILESIZE, d);
832
833 /* setup colour mode */
834 switch (depth) {
835 case 8:
836 h = CRMFB_MODE_TYP_I8;
837 tile_width = 512;
838 break;
839 case 16:
840 h = CRMFB_MODE_TYP_ARGB5;
841 tile_width = 256;
842 break;
843 case 32:
844 h = CRMFB_MODE_TYP_RGB8;
845 tile_width = 128;
846 break;
847 default:
848 panic("Unsupported depth");
849 }
850 d = h << CRMFB_MODE_TYP_SHIFT;
851 d |= CRMFB_MODE_BUF_BOTH << CRMFB_MODE_BUF_SHIFT;
852 for (i = 0; i < (32 * 4); i += 4)
853 bus_space_write_4(sc->sc_iot, sc->sc_ioh, CRMFB_MODE + i, d);
854 wbflush();
855
856 /* setup tile pointer, but don't turn on DMA yet! */
857 h = DMAADDR(sc->sc_dmai);
858 d = (h >> 9) << CRMFB_FRM_CONTROL_TILEPTR_SHIFT;
859 crmfb_write_reg(sc, CRMFB_FRM_CONTROL, d);
860
861 /* init framebuffer width and pixel size */
862 /*d = (1 << CRMFB_FRM_TILESIZE_WIDTH_SHIFT);*/
863
864 d = ((int)(sc->sc_width / tile_width)) <<
865 CRMFB_FRM_TILESIZE_WIDTH_SHIFT;
866 if ((sc->sc_width & (tile_width - 1)) != 0)
867 d |= sc->sc_tiles_y;
868
869 switch (depth) {
870 case 8:
871 h = CRMFB_FRM_TILESIZE_DEPTH_8;
872 break;
873 case 16:
874 h = CRMFB_FRM_TILESIZE_DEPTH_16;
875 break;
876 case 32:
877 h = CRMFB_FRM_TILESIZE_DEPTH_32;
878 break;
879 default:
880 panic("Unsupported depth");
881 }
882 d |= (h << CRMFB_FRM_TILESIZE_DEPTH_SHIFT);
883 crmfb_write_reg(sc, CRMFB_FRM_TILESIZE, d);
884
885 /*h = sc->sc_width * sc->sc_height / (512 / (depth >> 3));*/
886 h = sc->sc_height;
887 d = h << CRMFB_FRM_PIXSIZE_HEIGHT_SHIFT;
888 crmfb_write_reg(sc, CRMFB_FRM_PIXSIZE, d);
889
890 /* turn off firmware overlay and hardware cursor */
891 crmfb_write_reg(sc, CRMFB_OVR_WIDTH_TILE, 0);
892 crmfb_write_reg(sc, CRMFB_CURSOR_CONTROL, 0);
893
894 /* enable drawing again */
895 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_DOTCLOCK);
896 d |= (1 << CRMFB_DOTCLOCK_CLKRUN_SHIFT);
897 crmfb_write_reg(sc, CRMFB_DOTCLOCK, d);
898 crmfb_write_reg(sc, CRMFB_VT_XY, 0);
899
900 /* turn on DMA for the framebuffer */
901 d = bus_space_read_4(sc->sc_iot, sc->sc_ioh, CRMFB_FRM_CONTROL);
902 d |= (1 << CRMFB_FRM_CONTROL_DMAEN_SHIFT);
903 crmfb_write_reg(sc, CRMFB_FRM_CONTROL, d);
904
905 /* turn off sync-on-green */
906
907 wantsync = ARCBIOS->GetEnvironmentVariable("SyncOnGreen");
908 if ( (wantsync != NULL) && (wantsync[0] == 'n') ) {
909 d = ( 1 << CRMFB_VT_FLAGS_SYNC_LOW_LSB) &
910 CRMFB_REG_MASK(CRMFB_VT_FLAGS_SYNC_LOW_MSB,
911 CRMFB_VT_FLAGS_SYNC_LOW_LSB);
912 crmfb_write_reg(sc, CRMFB_VT_FLAGS, d);
913 }
914
915 sc->sc_depth = depth;
916
917 /* finally set up the drawing engine's TLB A */
918 v = (DMAADDR(sc->sc_dma) >> 16) & 0xffff;
919 tlbptr = 0;
920 tx = ((sc->sc_width + (tile_width - 1)) & ~(tile_width - 1)) /
921 tile_width;
922
923 #ifdef CRMFB_DEBUG
924 printf("tx: %d\n", tx);
925 #endif
926
927 for (i = 0; i < 16; i++) {
928 reg = 0;
929 shift = 64;
930 lptr = 0;
931 for (j = 0; j < tx; j++) {
932 shift -= 16;
933 reg |= (((uint64_t)(v | 0x8000)) << shift);
934 if (shift == 0) {
935 shift = 64;
936 bus_space_write_8(sc->sc_iot, sc->sc_reh,
937 CRIME_RE_TLB_A + tlbptr + lptr,
938 reg);
939 #ifdef CRMFB_DEBUG
940 printf("%04x: %016llx\n", tlbptr + lptr, reg);
941 #endif
942 reg = 0;
943 lptr += 8;
944 }
945 v++;
946 }
947 if (shift != 64) {
948 bus_space_write_8(sc->sc_iot, sc->sc_reh,
949 CRIME_RE_TLB_A + tlbptr + lptr, reg);
950 #ifdef CRMFB_DEBUG
951 printf("%04x: %016llx\n", tlbptr + lptr, reg);
952 #endif
953 }
954 tlbptr += 32;
955 }
956 sc->sc_scratch = (char *)KERNADDR(sc->sc_dma) + (0xf0000 * tx);
957
958 /* now put the last 64kB into the 1st linear TLB */
959 page = (sc->sc_linear >> 12) | 0x80000000;
960 tlbptr = 0;
961 for (i = 0; i < 8; i++) {
962 reg = ((uint64_t)page << 32) | (page + 1);
963 bus_space_write_8(sc->sc_iot, sc->sc_reh,
964 CRIME_RE_LINEAR_A + tlbptr, reg);
965 page += 2;
966 tlbptr += 8;
967 }
968 wbflush();
969
970 /* do some very basic engine setup */
971 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_CLIPMODE, 0);
972 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_WINOFFSET_SRC, 0);
973 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_WINOFFSET_DST, 0);
974 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_PLANEMASK,
975 0xffffffff);
976
977 bus_space_write_8(sc->sc_iot, sc->sc_reh, 0x20, 0);
978 bus_space_write_8(sc->sc_iot, sc->sc_reh, 0x28, 0);
979 bus_space_write_8(sc->sc_iot, sc->sc_reh, 0x30, 0);
980 bus_space_write_8(sc->sc_iot, sc->sc_reh, 0x38, 0);
981 bus_space_write_8(sc->sc_iot, sc->sc_reh, 0x40, 0);
982
983 switch (depth) {
984 case 8:
985 mode = DE_MODE_TLB_A | DE_MODE_BUFDEPTH_8 |
986 DE_MODE_TYPE_CI | DE_MODE_PIXDEPTH_8;
987 break;
988 case 16:
989 mode = DE_MODE_TLB_A | DE_MODE_BUFDEPTH_16 |
990 DE_MODE_TYPE_RGB | DE_MODE_PIXDEPTH_16;
991 break;
992 case 32:
993 mode = DE_MODE_TLB_A | DE_MODE_BUFDEPTH_32 |
994 DE_MODE_TYPE_RGBA | DE_MODE_PIXDEPTH_32;
995 break;
996 default:
997 panic("%s: unsuported colour depth %d\n", __func__,
998 depth);
999 }
1000 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_MODE_DST, mode);
1001 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_MODE_SRC, mode);
1002 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_XFER_STEP_X, 1);
1003 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_XFER_STEP_Y, 1);
1004
1005 /* initialize memory transfer engine */
1006 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_MODE,
1007 MTE_MODE_DST_ECC |
1008 (MTE_TLB_A << MTE_DST_TLB_SHIFT) |
1009 (MTE_TLB_A << MTE_SRC_TLB_SHIFT) |
1010 (MTE_DEPTH_8 << MTE_DEPTH_SHIFT) |
1011 MTE_MODE_COPY);
1012 sc->sc_mte_direction = 1;
1013 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_DST_Y_STEP, 1);
1014 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_SRC_Y_STEP, 1);
1015
1016 return 0;
1017 }
1018
1019 static void
1020 crmfb_set_mte_direction(struct crmfb_softc *sc, int dir)
1021 {
1022 if (dir == sc->sc_mte_direction)
1023 return;
1024
1025 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_DST_Y_STEP, dir);
1026 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_SRC_Y_STEP, dir);
1027 sc->sc_mte_direction = dir;
1028 }
1029
1030 static void
1031 crmfb_setup_palette(struct crmfb_softc *sc)
1032 {
1033 int i;
1034
1035 for (i = 0; i < 256; i++) {
1036 crmfb_set_palette(sc, i, rasops_cmap[(i * 3) + 2],
1037 rasops_cmap[(i * 3) + 1], rasops_cmap[(i * 3) + 0]);
1038 sc->sc_cmap_red[i] = rasops_cmap[(i * 3) + 2];
1039 sc->sc_cmap_green[i] = rasops_cmap[(i * 3) + 1];
1040 sc->sc_cmap_blue[i] = rasops_cmap[(i * 3) + 0];
1041 }
1042 }
1043
1044 static inline void
1045 crmfb_wait_idle(struct crmfb_softc *sc)
1046 {
1047 int i = 0;
1048
1049 do {
1050 i++;
1051 } while (((bus_space_read_4(sc->sc_iot, sc->sc_reh, CRIME_DE_STATUS) &
1052 CRIME_DE_IDLE) == 0) && (i < 100000000));
1053 if (i >= 100000000)
1054 aprint_error("crmfb_wait_idle() timed out\n");
1055 }
1056
1057 static void
1058 crmfb_fill_rect(struct crmfb_softc *sc, int x, int y, int width, int height,
1059 uint32_t colour)
1060 {
1061 crmfb_wait_idle(sc);
1062 crmfb_set_mte_direction(sc, 1);
1063 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_MODE,
1064 MTE_MODE_DST_ECC |
1065 (MTE_TLB_A << MTE_DST_TLB_SHIFT) |
1066 (MTE_TLB_A << MTE_SRC_TLB_SHIFT) |
1067 (MTE_DEPTH_8 << MTE_DEPTH_SHIFT) |
1068 0);
1069 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_BG, colour);
1070 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_DST0,
1071 (x << 16) | (y & 0xffff));
1072 bus_space_write_4(sc->sc_iot, sc->sc_reh,
1073 CRIME_MTE_DST1 | CRIME_DE_START,
1074 ((x + width - 1) << 16) | ((y + height - 1) & 0xffff));
1075 }
1076
1077 static void
1078 crmfb_bitblt(struct crmfb_softc *sc, int xs, int ys, int xd, int yd,
1079 int wi, int he, uint32_t rop)
1080 {
1081 uint32_t prim = DE_PRIM_RECTANGLE;
1082 int rxa, rya, rxe, rye, rxs, rys;
1083 crmfb_wait_idle(sc);
1084 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_DRAWMODE,
1085 DE_DRAWMODE_PLANEMASK | DE_DRAWMODE_BYTEMASK | DE_DRAWMODE_ROP |
1086 DE_DRAWMODE_XFER_EN);
1087 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_ROP, rop);
1088 if (xs < xd) {
1089 prim |= DE_PRIM_RL;
1090 rxe = xd;
1091 rxa = xd + wi - 1;
1092 rxs = xs + wi - 1;
1093 } else {
1094 prim |= DE_PRIM_LR;
1095 rxe = xd + wi - 1;
1096 rxa = xd;
1097 rxs = xs;
1098 }
1099 if (ys < yd) {
1100 prim |= DE_PRIM_BT;
1101 rye = yd;
1102 rya = yd + he - 1;
1103 rys = ys + he - 1;
1104 } else {
1105 prim |= DE_PRIM_TB;
1106 rye = yd + he - 1;
1107 rya = yd;
1108 rys = ys;
1109 }
1110 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_PRIMITIVE, prim);
1111 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_XFER_ADDR_SRC,
1112 (rxs << 16) | (rys & 0xffff));
1113 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_X_VERTEX_0,
1114 (rxa << 16) | (rya & 0xffff));
1115 bus_space_write_4(sc->sc_iot, sc->sc_reh,
1116 CRIME_DE_X_VERTEX_1 | CRIME_DE_START,
1117 (rxe << 16) | (rye & 0xffff));
1118 }
1119
1120 static void
1121 crmfb_scroll(struct crmfb_softc *sc, int xs, int ys, int xd, int yd,
1122 int wi, int he)
1123 {
1124 int rxa, rya, rxe, rye, rxd, ryd, rxde, ryde;
1125
1126 rxa = xs;
1127 rxe = xs + wi - 1;
1128 rxd = xd;
1129 rxde = xd + wi - 1;
1130
1131 crmfb_wait_idle(sc);
1132
1133 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_MODE,
1134 MTE_MODE_DST_ECC |
1135 (MTE_TLB_A << MTE_DST_TLB_SHIFT) |
1136 (MTE_TLB_A << MTE_SRC_TLB_SHIFT) |
1137 (MTE_DEPTH_8 << MTE_DEPTH_SHIFT) |
1138 MTE_MODE_COPY);
1139
1140 if (ys < yd) {
1141 /* bottom to top */
1142 rye = ys;
1143 rya = ys + he - 1;
1144 ryd = yd + he - 1;
1145 ryde = yd;
1146 crmfb_set_mte_direction(sc, -1);
1147 } else {
1148 /* top to bottom */
1149 rye = ys + he - 1;
1150 rya = ys;
1151 ryd = yd;
1152 ryde = yd + he - 1;
1153 crmfb_set_mte_direction(sc, 1);
1154 }
1155 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_SRC0,
1156 (rxa << 16) | rya);
1157 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_SRC1,
1158 (rxe << 16) | rye);
1159 bus_space_write_4(sc->sc_iot, sc->sc_reh,
1160 CRIME_MTE_DST0,
1161 (rxd << 16) | ryd);
1162 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_DST1 |
1163 CRIME_DE_START,
1164 (rxde << 16) | ryde);
1165 }
1166
1167 #ifdef CRMFB_DEBUG
1168 void
1169 crmfb_test_mte(struct crmfb_softc *sc)
1170 {
1171 uint64_t addr, reg;
1172 uint32_t addrs[256];
1173 int i, j, boo;
1174
1175 crmfb_wait_idle(sc);
1176 addr = (uint64_t)(DMAADDR(sc->sc_dma) + sc->sc_fbsize);
1177 addr = addr >> 12;
1178 for (i = 0; i < 64; i += 8) {
1179 #if 1
1180 reg = (addr << 32) | (addr + 1) | 0x8000000080000000LL;
1181 bus_space_write_8(sc->sc_iot, sc->sc_reh,
1182 CRIME_RE_LINEAR_A + i, reg);
1183 printf(" %08x", (uint32_t)(addr & 0xffffffff));
1184 #endif
1185 addr += 2;
1186 }
1187 printf("\n");
1188 memset(sc->sc_scratch, 4, 0x10000);
1189 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_MODE_SRC,
1190 DE_MODE_LIN_A | DE_MODE_BUFDEPTH_8 | DE_MODE_TYPE_CI |
1191 DE_MODE_PIXDEPTH_8);
1192 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_XFER_STRD_SRC, 1);
1193 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_DRAWMODE,
1194 DE_DRAWMODE_PLANEMASK | DE_DRAWMODE_BYTEMASK | DE_DRAWMODE_ROP |
1195 DE_DRAWMODE_XFER_EN);
1196 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_ROP, 3);
1197 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_PRIMITIVE,
1198 DE_PRIM_RECTANGLE | DE_PRIM_TB);
1199 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_XFER_ADDR_SRC, 0);
1200 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_X_VERTEX_0,
1201 0x02000000);
1202 bus_space_write_4(sc->sc_iot, sc->sc_reh,
1203 CRIME_DE_X_VERTEX_1 | CRIME_DE_START,
1204 0x04000100);
1205
1206 crmfb_wait_idle(sc);
1207 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_MODE_SRC,
1208 DE_MODE_TLB_A | DE_MODE_BUFDEPTH_8 | DE_MODE_TYPE_CI |
1209 DE_MODE_PIXDEPTH_8);
1210
1211 #if 1
1212 delay(4000000);
1213
1214 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_BG, 0x15151515);
1215 crmfb_wait_idle(sc);
1216 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_MODE,
1217 MTE_MODE_DST_ECC |
1218 (MTE_TLB_LIN_A << MTE_DST_TLB_SHIFT) |
1219 (MTE_TLB_A << MTE_SRC_TLB_SHIFT) |
1220 (MTE_DEPTH_8 << MTE_DEPTH_SHIFT) |
1221 0/*MTE_MODE_COPY*/);
1222 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_DST_STRIDE, 1);
1223 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_SRC_STRIDE, 1);
1224 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_SRC0, 0x00000000);
1225 //bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_SRC1, 0x01000100);
1226 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_DST0, 0x00000000);
1227 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_DST1 |
1228 CRIME_DE_START, 0x00010000);
1229 //status[9] = bus_space_read_4(sc->sc_iot, sc->sc_reh, CRIME_DE_STATUS);
1230 crmfb_wait_idle(sc);
1231 /* now look for 0x05050505 in RAM */
1232
1233 boo = 0;
1234 for (i = 0xA0000000; i < 0xB0000000; i += 0x1000)
1235 if (*((uint32_t *)i) == 0x15151515) {
1236 /* see if there's more */
1237 j = 4;
1238 while ((j < 0x100) && (*((uint32_t *)(i + j)) ==
1239 0x15151515))
1240 j += 4;
1241 if (j > 0x20) {
1242 addrs[boo] = i;
1243 boo++;
1244 }
1245 }
1246 printf("...");
1247 for (i = 0; i < boo; i++)
1248 printf(" %08x", addrs[i]);
1249 printf("\n");
1250 #endif
1251 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_MODE_SRC,
1252 DE_MODE_LIN_A | DE_MODE_BUFDEPTH_8 | DE_MODE_TYPE_CI |
1253 DE_MODE_PIXDEPTH_8);
1254 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_XFER_STRD_SRC, 1);
1255 crmfb_bitblt(sc, 0, 0, 400, 0, 512, 64, 3);
1256 crmfb_wait_idle(sc);
1257 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_DE_MODE_SRC,
1258 DE_MODE_TLB_A | DE_MODE_BUFDEPTH_8 | DE_MODE_TYPE_CI |
1259 DE_MODE_PIXDEPTH_8);
1260 #if 0
1261 bus_space_write_4(sc->sc_iot, sc->sc_reh, CRIME_MTE_MODE,
1262 MTE_MODE_DST_ECC |
1263 (MTE_TLB_A << MTE_DST_TLB_SHIFT) |
1264 (MTE_TLB_A << MTE_SRC_TLB_SHIFT) |
1265 (MTE_DEPTH_8 << MTE_DEPTH_SHIFT) |
1266 0/*MTE_MODE_COPY*/);
1267 #endif
1268 delay(4000000);
1269 #if 0
1270 for (i = 0; i < 128; i+=8)
1271 printf("%016llx\n", bus_space_read_8(sc->sc_iot, sc->sc_reh,
1272 CRIME_RE_LINEAR_B + i));
1273 #endif
1274 #if 0
1275 printf("flush: %08x\n",
1276 bus_space_read_4(sc->sc_iot, sc->sc_reh, CRIME_DE_FLUSH));
1277 #endif
1278 }
1279 #endif /* CRMFB_DEBUG */
1280
1281 static void
1282 crmfb_copycols(void *cookie, int row, int srccol, int dstcol, int ncols)
1283 {
1284 struct rasops_info *ri = cookie;
1285 struct vcons_screen *scr = ri->ri_hw;
1286 int32_t xs, xd, y, width, height;
1287
1288 xs = ri->ri_xorigin + ri->ri_font->fontwidth * srccol;
1289 xd = ri->ri_xorigin + ri->ri_font->fontwidth * dstcol;
1290 y = ri->ri_yorigin + ri->ri_font->fontheight * row;
1291 width = ri->ri_font->fontwidth * ncols;
1292 height = ri->ri_font->fontheight;
1293 crmfb_bitblt(scr->scr_cookie, xs, y, xd, y, width, height, 3);
1294 }
1295
1296 static void
1297 crmfb_erasecols(void *cookie, int row, int startcol, int ncols, long fillattr)
1298 {
1299 struct rasops_info *ri = cookie;
1300 struct vcons_screen *scr = ri->ri_hw;
1301 int32_t x, y, width, height, bg;
1302
1303 x = ri->ri_xorigin + ri->ri_font->fontwidth * startcol;
1304 y = ri->ri_yorigin + ri->ri_font->fontheight * row;
1305 width = ri->ri_font->fontwidth * ncols;
1306 height = ri->ri_font->fontheight;
1307 bg = (uint32_t)ri->ri_devcmap[(fillattr >> 16) & 0xff];
1308 crmfb_fill_rect(scr->scr_cookie, x, y, width, height, bg);
1309 }
1310
1311 static void
1312 crmfb_copyrows(void *cookie, int srcrow, int dstrow, int nrows)
1313 {
1314 struct rasops_info *ri = cookie;
1315 struct vcons_screen *scr = ri->ri_hw;
1316 int32_t x, ys, yd, width, height;
1317
1318 x = ri->ri_xorigin;
1319 ys = ri->ri_yorigin + ri->ri_font->fontheight * srcrow;
1320 yd = ri->ri_yorigin + ri->ri_font->fontheight * dstrow;
1321 width = ri->ri_emuwidth;
1322 height = ri->ri_font->fontheight * nrows;
1323
1324 crmfb_scroll(scr->scr_cookie, x, ys, x, yd, width, height);
1325 }
1326
1327 static void
1328 crmfb_eraserows(void *cookie, int row, int nrows, long fillattr)
1329 {
1330 struct rasops_info *ri = cookie;
1331 struct vcons_screen *scr = ri->ri_hw;
1332 int32_t x, y, width, height, bg;
1333
1334 if ((row == 0) && (nrows == ri->ri_rows)) {
1335 x = y = 0;
1336 width = ri->ri_width;
1337 height = ri->ri_height;
1338 } else {
1339 x = ri->ri_xorigin;
1340 y = ri->ri_yorigin + ri->ri_font->fontheight * row;
1341 width = ri->ri_emuwidth;
1342 height = ri->ri_font->fontheight * nrows;
1343 }
1344 bg = (uint32_t)ri->ri_devcmap[(fillattr >> 16) & 0xff];
1345 crmfb_fill_rect(scr->scr_cookie, x, y, width, height, bg);
1346 }
1347
1348 static void
1349 crmfb_cursor(void *cookie, int on, int row, int col)
1350 {
1351 struct rasops_info *ri = cookie;
1352 struct vcons_screen *scr = ri->ri_hw;
1353 struct crmfb_softc *sc = scr->scr_cookie;
1354 int x, y, wi,he;
1355
1356 wi = ri->ri_font->fontwidth;
1357 he = ri->ri_font->fontheight;
1358
1359 if (ri->ri_flg & RI_CURSOR) {
1360 x = ri->ri_ccol * wi + ri->ri_xorigin;
1361 y = ri->ri_crow * he + ri->ri_yorigin;
1362 crmfb_bitblt(sc, x, y, x, y, wi, he, 12);
1363 ri->ri_flg &= ~RI_CURSOR;
1364 }
1365
1366 ri->ri_crow = row;
1367 ri->ri_ccol = col;
1368
1369 if (on)
1370 {
1371 x = ri->ri_ccol * wi + ri->ri_xorigin;
1372 y = ri->ri_crow * he + ri->ri_yorigin;
1373 crmfb_bitblt(sc, x, y, x, y, wi, he, 12);
1374 ri->ri_flg |= RI_CURSOR;
1375 }
1376 }
1377
1378 static void
1379 crmfb_putchar(void *cookie, int row, int col, u_int c, long attr)
1380 {
1381 struct rasops_info *ri = cookie;
1382 struct vcons_screen *scr = ri->ri_hw;
1383 struct crmfb_softc *sc = scr->scr_cookie;
1384 struct rasops_info *fri = &sc->sc_rasops;
1385 int bg;
1386 int x, y, wi, he, xs;
1387
1388 wi = ri->ri_font->fontwidth;
1389 he = ri->ri_font->fontheight;
1390
1391 x = ri->ri_xorigin + col * wi;
1392 y = ri->ri_yorigin + row * he;
1393
1394 bg = ri->ri_devcmap[(attr >> 16) & 0xff];
1395 if (c == 0x20) {
1396 crmfb_fill_rect(sc, x, y, wi, he, bg);
1397 } else {
1398 /*
1399 * we rotate over all available character cells in the scratch
1400 * tile. The idea is to have more cells than there's room for
1401 * drawing commands in the engine's pipeline so we don't have
1402 * to wait for the engine until we're done drawing the
1403 * character and ready to blit it into place
1404 */
1405 fri->ri_ops.putchar(fri, 0, sc->sc_current_cell, c, attr);
1406 xs = sc->sc_current_cell * wi;
1407 sc->sc_current_cell++;
1408 if (sc->sc_current_cell >= sc->sc_cells)
1409 sc->sc_current_cell = 0;
1410 crmfb_bitblt(sc, xs, 2048-128, x, y, wi, he, 3);
1411 }
1412 }
1413