sti.c revision 1.29 1 /* $NetBSD: sti.c,v 1.29 2021/03/14 08:13:58 skrll Exp $ */
2
3 /* $OpenBSD: sti.c,v 1.61 2009/09/05 14:09:35 miod Exp $ */
4
5 /*
6 * Copyright (c) 2000-2003 Michael Shalayeff
7 * All rights reserved.
8 *
9 * Redistribution and use in source and binary forms, with or without
10 * modification, are permitted provided that the following conditions
11 * are met:
12 * 1. Redistributions of source code must retain the above copyright
13 * notice, this list of conditions and the following disclaimer.
14 * 2. Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in the
16 * documentation and/or other materials provided with the distribution.
17 *
18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21 * IN NO EVENT SHALL THE AUTHOR OR HIS RELATIVES BE LIABLE FOR ANY DIRECT,
22 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
23 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
24 * SERVICES; LOSS OF MIND, USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
25 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
26 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
27 * IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
28 * THE POSSIBILITY OF SUCH DAMAGE.
29 */
30 /*
31 * TODO:
32 * call sti procs asynchronously;
33 * implement console scroll-back;
34 * X11 support on more models.
35 */
36
37 #include <sys/cdefs.h>
38 __KERNEL_RCSID(0, "$NetBSD: sti.c,v 1.29 2021/03/14 08:13:58 skrll Exp $");
39
40 #include "wsdisplay.h"
41
42 #include <sys/param.h>
43 #include <sys/systm.h>
44 #include <sys/device.h>
45 #include <sys/malloc.h>
46
47 #include <uvm/uvm_extern.h>
48
49 #include <sys/bus.h>
50
51 #include <dev/wscons/wsdisplayvar.h>
52 #include <dev/wscons/wsconsio.h>
53
54 #include <dev/ic/stireg.h>
55 #include <dev/ic/stivar.h>
56
57 #ifdef STIDEBUG
58
59 #define DPRINTF(s) do { \
60 if (stidebug) \
61 printf s; \
62 } while(0)
63
64 int stidebug = 1;
65 #else
66 #define DPRINTF(s) /* */
67 #endif
68
69 void sti_cursor(void *, int, int, int);
70 int sti_mapchar(void *, int, u_int *);
71 void sti_putchar(void *, int, int, u_int, long);
72 void sti_copycols(void *, int, int, int, int);
73 void sti_erasecols(void *, int, int, int, long);
74 void sti_copyrows(void *, int, int, int);
75 void sti_eraserows(void *, int, int, long);
76 int sti_alloc_attr(void *, int, int, int, long *);
77
78 /* pseudo attribute ops for sti ROM putchar function */
79 #define WSATTR_FG_SHIFT 24
80 #define WSATTR_BG_SHIFT 16
81 #define WSATTR_UNPACK_FG(attr) (((attr) >> WSATTR_FG_SHIFT) & 0xff)
82 #define WSATTR_UNPACK_BG(attr) (((attr) >> WSATTR_BG_SHIFT) & 0xff)
83 #define WSATTR_UNPACK_FLAG(attr) ((attr) & WSATTR_USERMASK)
84 #define WSATTR_PACK_FG(fg) ((fg) << WSATTR_FG_SHIFT)
85 #define WSATTR_PACK_BG(bg) ((bg) << WSATTR_BG_SHIFT)
86 #define WSATTR_PACK_FLAG(flag) ((flag))
87 #define WSATTR_PACK(fg, bg, flag) \
88 (WSATTR_PACK_FG(fg) | WSATTR_PACK_BG(bg) | WSATTR_PACK_FLAG(flag))
89
90 struct wsdisplay_emulops sti_emulops = {
91 .cursor = sti_cursor,
92 .mapchar = sti_mapchar,
93 .putchar = sti_putchar,
94 .copycols = sti_copycols,
95 .erasecols = sti_erasecols,
96 .copyrows = sti_copyrows,
97 .eraserows = sti_eraserows,
98 .allocattr = sti_alloc_attr
99 };
100
101 const struct wsdisplay_accessops sti_accessops = {
102 .ioctl = sti_ioctl,
103 .mmap = sti_mmap,
104 .alloc_screen = sti_alloc_screen,
105 .free_screen = sti_free_screen,
106 .show_screen = sti_show_screen,
107 .load_font = sti_load_font
108 };
109
110 enum sti_bmove_funcs {
111 bmf_clear, bmf_copy, bmf_invert, bmf_underline
112 };
113
114 void sti_bmove(struct sti_screen *, int, int, int, int, int, int,
115 enum sti_bmove_funcs);
116 int sti_inqcfg(struct sti_screen *, struct sti_inqconfout *);
117 int sti_setcment(struct sti_screen *, u_int, u_char, u_char, u_char);
118
119 struct sti_screen *sti_attach_screen(struct sti_softc *, int);
120 void sti_describe_screen(struct sti_softc *, struct sti_screen *);
121
122 int sti_fetchfonts(struct sti_screen *, struct sti_inqconfout *, uint32_t,
123 u_int);
124 void sti_region_setup(struct sti_screen *);
125 int sti_rom_setup(struct sti_rom *, bus_space_tag_t, bus_space_tag_t,
126 bus_space_handle_t, bus_addr_t *, u_int);
127 int sti_screen_setup(struct sti_screen *, int);
128
129 int ngle_default_putcmap(struct sti_screen *, u_int, u_int);
130
131 #ifndef SMALL_KERNEL
132 void ngle_artist_setupfb(struct sti_screen *);
133 void ngle_elk_setupfb(struct sti_screen *);
134 void ngle_timber_setupfb(struct sti_screen *);
135 int ngle_putcmap(struct sti_screen *, u_int, u_int);
136 #endif
137
138 #define STI_ENABLE_ROM(sc) \
139 do { \
140 if ((sc) != NULL && (sc)->sc_enable_rom != NULL) \
141 (*(sc)->sc_enable_rom)(sc); \
142 } while (0)
143 #define STI_DISABLE_ROM(sc) \
144 do { \
145 if ((sc) != NULL && (sc)->sc_disable_rom != NULL) \
146 (*(sc)->sc_disable_rom)(sc); \
147 } while (0)
148
149 /* Macros to read larger than 8 bit values from byte roms */
150 #define parseshort(o) \
151 ((bus_space_read_1(memt, romh, (o) + 3) << 8) | \
152 (bus_space_read_1(memt, romh, (o) + 7)))
153 #define parseword(o) \
154 ((bus_space_read_1(memt, romh, (o) + 3) << 24) | \
155 (bus_space_read_1(memt, romh, (o) + 7) << 16) | \
156 (bus_space_read_1(memt, romh, (o) + 11) << 8) | \
157 (bus_space_read_1(memt, romh, (o) + 15)))
158
159 int
160 sti_attach_common(struct sti_softc *sc, bus_space_tag_t iot,
161 bus_space_tag_t memt, bus_space_handle_t romh, u_int codebase)
162 {
163 struct sti_rom *rom;
164 int rc;
165
166 rom = (struct sti_rom *)malloc(sizeof(*rom), M_DEVBUF,
167 M_WAITOK | M_ZERO);
168 rom->rom_softc = sc;
169 rc = sti_rom_setup(rom, iot, memt, romh, sc->bases, codebase);
170 if (rc != 0) {
171 free(rom, M_DEVBUF);
172 return rc;
173 }
174
175 sc->sc_rom = rom;
176
177 sti_describe(sc);
178
179 sc->sc_scr = sti_attach_screen(sc,
180 sc->sc_flags & STI_CONSOLE ? 0 : STI_CLEARSCR);
181 if (sc->sc_scr == NULL)
182 rc = ENOMEM;
183
184 return rc;
185 }
186
187 struct sti_screen *
188 sti_attach_screen(struct sti_softc *sc, int flags)
189 {
190 struct sti_screen *scr;
191 int rc;
192
193 scr = (struct sti_screen *)malloc(sizeof(*scr), M_DEVBUF,
194 M_WAITOK | M_ZERO);
195 scr->scr_rom = sc->sc_rom;
196 rc = sti_screen_setup(scr, flags);
197 if (rc != 0) {
198 free(scr, M_DEVBUF);
199 return NULL;
200 }
201
202 sti_describe_screen(sc, scr);
203
204 return scr;
205 }
206
207 int
208 sti_rom_setup(struct sti_rom *rom, bus_space_tag_t iot, bus_space_tag_t memt,
209 bus_space_handle_t romh, bus_addr_t *bases, u_int codebase)
210 {
211 struct sti_dd *dd;
212 int error, size, i;
213
214 KASSERT(rom != NULL);
215 STI_ENABLE_ROM(rom->rom_softc);
216
217 rom->iot = iot;
218 rom->memt = memt;
219 rom->romh = romh;
220 rom->bases = bases;
221
222 /*
223 * Get ROM header and code function pointers.
224 */
225
226 dd = &rom->rom_dd;
227 rom->rom_devtype = bus_space_read_1(memt, romh, 3);
228 if (rom->rom_devtype == STI_DEVTYPE1) {
229 dd->dd_type = bus_space_read_1(memt, romh, 0x03);
230 dd->dd_nmon = bus_space_read_1(memt, romh, 0x07);
231 dd->dd_grrev = bus_space_read_1(memt, romh, 0x0b);
232 dd->dd_lrrev = bus_space_read_1(memt, romh, 0x0f);
233 dd->dd_grid[0] = parseword(0x10);
234 dd->dd_grid[1] = parseword(0x20);
235 dd->dd_fntaddr = parseword(0x30) & ~3;
236 dd->dd_maxst = parseword(0x40);
237 dd->dd_romend = parseword(0x50) & ~3;
238 dd->dd_reglst = parseword(0x60) & ~3;
239 dd->dd_maxreent = parseshort(0x70);
240 dd->dd_maxtimo = parseshort(0x78);
241 dd->dd_montbl = parseword(0x80) & ~3;
242 dd->dd_udaddr = parseword(0x90) & ~3;
243 dd->dd_stimemreq = parseword(0xa0);
244 dd->dd_udsize = parseword(0xb0);
245 dd->dd_pwruse = parseshort(0xc0);
246 dd->dd_bussup = bus_space_read_1(memt, romh, 0xcb);
247 dd->dd_ebussup = bus_space_read_1(memt, romh, 0xcf);
248 dd->dd_altcodet = bus_space_read_1(memt, romh, 0xd3);
249 dd->dd_eddst[0] = bus_space_read_1(memt, romh, 0xd7);
250 dd->dd_eddst[1] = bus_space_read_1(memt, romh, 0xdb);
251 dd->dd_eddst[2] = bus_space_read_1(memt, romh, 0xdf);
252 dd->dd_cfbaddr = parseword(0xe0) & ~3;
253
254 codebase <<= 2;
255 dd->dd_pacode[0x0] = parseword(codebase + 0x000) & ~3;
256 dd->dd_pacode[0x1] = parseword(codebase + 0x010) & ~3;
257 dd->dd_pacode[0x2] = parseword(codebase + 0x020) & ~3;
258 dd->dd_pacode[0x3] = parseword(codebase + 0x030) & ~3;
259 dd->dd_pacode[0x4] = parseword(codebase + 0x040) & ~3;
260 dd->dd_pacode[0x5] = parseword(codebase + 0x050) & ~3;
261 dd->dd_pacode[0x6] = parseword(codebase + 0x060) & ~3;
262 dd->dd_pacode[0x7] = parseword(codebase + 0x070) & ~3;
263 dd->dd_pacode[0x8] = parseword(codebase + 0x080) & ~3;
264 dd->dd_pacode[0x9] = parseword(codebase + 0x090) & ~3;
265 dd->dd_pacode[0xa] = parseword(codebase + 0x0a0) & ~3;
266 dd->dd_pacode[0xb] = parseword(codebase + 0x0b0) & ~3;
267 dd->dd_pacode[0xc] = parseword(codebase + 0x0c0) & ~3;
268 dd->dd_pacode[0xd] = parseword(codebase + 0x0d0) & ~3;
269 dd->dd_pacode[0xe] = parseword(codebase + 0x0e0) & ~3;
270 dd->dd_pacode[0xf] = parseword(codebase + 0x0f0) & ~3;
271 } else { /* STI_DEVTYPE4 */
272 bus_space_read_region_stream_4(memt, romh, 0, (uint32_t *)dd,
273 sizeof(*dd) / 4);
274 /* fix pacode... */
275 bus_space_read_region_stream_4(memt, romh, codebase,
276 (uint32_t *)dd->dd_pacode, sizeof(dd->dd_pacode) / 4);
277 }
278
279 STI_DISABLE_ROM(rom->rom_softc);
280
281 DPRINTF(("dd:\n"
282 "devtype=%x, rev=%x;%d, altt=%x, gid=%08x%08x, font=%x, mss=%x\n"
283 "end=%x, regions=%x, msto=%x, timo=%d, mont=%x, user=%x[%x]\n"
284 "memrq=%x, pwr=%d, bus=%x, ebus=%x, cfb=%x\n"
285 "code=",
286 dd->dd_type & 0xff, dd->dd_grrev, dd->dd_lrrev, dd->dd_altcodet,
287 dd->dd_grid[0], dd->dd_grid[1], dd->dd_fntaddr, dd->dd_maxst,
288 dd->dd_romend, dd->dd_reglst, dd->dd_maxreent, dd->dd_maxtimo,
289 dd->dd_montbl, dd->dd_udaddr, dd->dd_udsize, dd->dd_stimemreq,
290 dd->dd_pwruse, dd->dd_bussup, dd->dd_ebussup, dd->dd_cfbaddr));
291 DPRINTF(("%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x,%x\n",
292 dd->dd_pacode[0x0], dd->dd_pacode[0x1], dd->dd_pacode[0x2],
293 dd->dd_pacode[0x3], dd->dd_pacode[0x4], dd->dd_pacode[0x5],
294 dd->dd_pacode[0x6], dd->dd_pacode[0x7], dd->dd_pacode[0x8],
295 dd->dd_pacode[0x9], dd->dd_pacode[0xa], dd->dd_pacode[0xb],
296 dd->dd_pacode[0xc], dd->dd_pacode[0xd], dd->dd_pacode[0xe],
297 dd->dd_pacode[0xf]));
298
299 /*
300 * Figure out how many bytes we need for the STI code.
301 * Note there could be fewer than STI_END pointer entries
302 * populated, especially on older devices.
303 */
304 for (i = STI_END; dd->dd_pacode[i] == 0; i--)
305 ;
306
307 size = dd->dd_pacode[i] - dd->dd_pacode[STI_BEGIN];
308
309 if (rom->rom_devtype == STI_DEVTYPE1)
310 size = (size + 3) / 4;
311 if (size == 0) {
312 aprint_error(": no code for the requested platform\n");
313 return EINVAL;
314 }
315
316 if (!(rom->rom_code = uvm_km_alloc(kernel_map, round_page(size), 0,
317 UVM_KMF_WIRED))) {
318 aprint_error(": cannot allocate %u bytes for code\n", size);
319 return ENOMEM;
320 }
321 DPRINTF(("code=0x%lx[%x]\n", rom->rom_code, size));
322
323 /*
324 * Copy code into memory and make it executable.
325 */
326
327 STI_ENABLE_ROM(rom->rom_softc);
328
329 if (rom->rom_devtype == STI_DEVTYPE1) {
330 uint8_t *p;
331 uint32_t addr, eaddr;
332
333 p = (uint8_t *)rom->rom_code;
334
335 for (addr = dd->dd_pacode[STI_BEGIN], eaddr = addr + size * 4;
336 addr < eaddr; addr += 4 ) {
337 *p++ = bus_space_read_4(memt, romh, addr) & 0xff;
338 }
339 } else { /* STI_DEVTYPE4 */
340 bus_space_read_region_stream_4(memt, romh,
341 dd->dd_pacode[STI_BEGIN], (uint32_t *)rom->rom_code,
342 size / 4);
343 }
344
345 STI_DISABLE_ROM(rom->rom_softc);
346
347 if ((error = uvm_map_protect(kernel_map, rom->rom_code,
348 rom->rom_code + round_page(size), UVM_PROT_RX, FALSE))) {
349 aprint_error(": uvm_map_protect failed (%d)\n", error);
350 uvm_km_free(kernel_map, rom->rom_code, round_page(size),
351 UVM_KMF_WIRED);
352 return error;
353 }
354
355 /*
356 * Setup code function pointers.
357 */
358
359 #define O(i) \
360 (dd->dd_pacode[(i)] == 0 ? 0 : \
361 (rom->rom_code + (dd->dd_pacode[(i)] - dd->dd_pacode[0]) / \
362 (rom->rom_devtype == STI_DEVTYPE1 ? 4 : 1)))
363
364 rom->init = (sti_init_t)O(STI_INIT_GRAPH);
365 rom->mgmt = (sti_mgmt_t)O(STI_STATE_MGMT);
366 rom->unpmv = (sti_unpmv_t)O(STI_FONT_UNPMV);
367 rom->blkmv = (sti_blkmv_t)O(STI_BLOCK_MOVE);
368 rom->test = (sti_test_t)O(STI_SELF_TEST);
369 rom->exhdl = (sti_exhdl_t)O(STI_EXCEP_HDLR);
370 rom->inqconf = (sti_inqconf_t)O(STI_INQ_CONF);
371 rom->scment = (sti_scment_t)O(STI_SCM_ENT);
372 rom->dmac = (sti_dmac_t)O(STI_DMA_CTRL);
373 rom->flowc = (sti_flowc_t)O(STI_FLOW_CTRL);
374 rom->utiming = (sti_utiming_t)O(STI_UTIMING);
375 rom->pmgr = (sti_pmgr_t)O(STI_PROC_MGR);
376 rom->util = (sti_util_t)O(STI_UTIL);
377
378 #undef O
379
380 /*
381 * Set colormap entry is not implemented until 8.04, so force
382 * a NULL pointer here.
383 */
384 if (dd->dd_grrev < STI_REVISION(8, 4)) {
385 rom->scment = NULL;
386 }
387
388 return 0;
389 }
390
391 /*
392 * Map all regions.
393 */
394 void
395 sti_region_setup(struct sti_screen *scr)
396 {
397 struct sti_rom *rom = scr->scr_rom;
398 bus_space_tag_t memt = rom->memt;
399 bus_space_handle_t romh = rom->romh;
400 bus_addr_t *bases = rom->bases;
401 struct sti_dd *dd = &rom->rom_dd;
402 struct sti_cfg *cc = &scr->scr_cfg;
403 struct sti_region regions[STI_REGION_MAX], *r;
404 u_int regno, regcnt;
405 bus_addr_t addr;
406
407 DPRINTF(("stiregions @ %x:\n", dd->dd_reglst));
408
409 /*
410 * Read the region information.
411 */
412
413 STI_ENABLE_ROM(rom->rom_softc);
414
415 if (rom->rom_devtype == STI_DEVTYPE1) {
416 for (regno = 0; regno < STI_REGION_MAX; regno++)
417 *(u_int *)(regions + regno) =
418 parseword(dd->dd_reglst + regno * 0x10);
419 } else {
420 bus_space_read_region_stream_4(memt, romh, dd->dd_reglst,
421 (uint32_t *)regions, sizeof(regions) / 4);
422 }
423
424 STI_DISABLE_ROM(rom->rom_softc);
425
426 /*
427 * Count them.
428 */
429
430 for (regcnt = 0, r = regions; regcnt < STI_REGION_MAX; regcnt++, r++)
431 if (r->last)
432 break;
433 regcnt++;
434
435 /*
436 * Map them.
437 */
438
439 for (regno = 0, r = regions; regno < regcnt; regno++, r++) {
440 if (r->length == 0)
441 continue;
442
443 /*
444 * Assume an existing mapping exists.
445 */
446 addr = bases[regno] + (r->offset << PGSHIFT);
447 DPRINTF(("%08x @ 0x%08x%s%s%s%s",
448 r->length << PGSHIFT, (int)addr, r->sys_only ? " sys" : "",
449 r->cache ? " cache" : "", r->btlb ? " btlb" : "",
450 r->last ? " last" : ""));
451
452 /*
453 * Region #0 is always the rom, and it should have been
454 * mapped already.
455 * XXX This expects a 1:1 mapping...
456 */
457 if (regno == 0 && romh == bases[0]) {
458 cc->regions[0] = addr;
459 DPRINTF(("\n"));
460 continue;
461 }
462
463 if (bus_space_map(memt, addr, r->length << PGSHIFT,
464 BUS_SPACE_MAP_LINEAR | (r->cache ?
465 BUS_SPACE_MAP_CACHEABLE : 0), &rom->regh[regno]) != 0) {
466 rom->regh[regno] = romh; /* XXX */
467 DPRINTF((" - already mapped region\n"));
468 } else {
469 addr = (bus_addr_t)
470 bus_space_vaddr(memt, rom->regh[regno]);
471 if (regno == 1) {
472 DPRINTF((" - fb"));
473 scr->fbaddr = addr;
474 scr->fblen = r->length << PGSHIFT;
475 }
476 DPRINTF(("\n"));
477 }
478
479 cc->regions[regno] = addr;
480 }
481
482 #ifdef STIDEBUG
483 /*
484 * Make sure we'll trap accessing unmapped regions
485 */
486 for (regno = 0; regno < STI_REGION_MAX; regno++)
487 if (cc->regions[regno] == 0)
488 cc->regions[regno] = 0x81234567;
489 #endif
490 }
491
492 int
493 sti_screen_setup(struct sti_screen *scr, int flags)
494 {
495 struct sti_rom *rom = scr->scr_rom;
496 bus_space_tag_t memt = rom->memt;
497 bus_space_handle_t romh = rom->romh;
498 struct sti_dd *dd = &rom->rom_dd;
499 struct sti_cfg *cc = &scr->scr_cfg;
500 struct sti_inqconfout cfg;
501 struct sti_einqconfout ecfg;
502 #ifdef STIDEBUG
503 char buf[256];
504 #endif
505 int error, i;
506 int geometry_kluge = 0;
507 u_int fontindex = 0;
508
509 KASSERT(scr != NULL);
510 memset(cc, 0, sizeof(*cc));
511 cc->ext_cfg = &scr->scr_ecfg;
512 memset(cc->ext_cfg, 0, sizeof(*cc->ext_cfg));
513
514 if (dd->dd_stimemreq) {
515 scr->scr_ecfg.addr =
516 malloc(dd->dd_stimemreq, M_DEVBUF, M_WAITOK);
517 }
518
519 sti_region_setup(scr);
520
521 if ((error = sti_init(scr, 0))) {
522 aprint_error(": cannot initialize (%d)\n", error);
523 goto fail;
524 }
525
526 memset(&cfg, 0, sizeof(cfg));
527 memset(&ecfg, 0, sizeof(ecfg));
528 cfg.ext = &ecfg;
529 if ((error = sti_inqcfg(scr, &cfg))) {
530 aprint_error(": error %d inquiring config\n", error);
531 goto fail;
532 }
533
534 /*
535 * Older (rev 8.02) boards report wrong offset values,
536 * similar to the displayable area size, at least in m68k mode.
537 * Attempt to detect this and adjust here.
538 */
539 if (cfg.owidth == cfg.width &&
540 cfg.oheight == cfg.height)
541 geometry_kluge = 1;
542
543 if (geometry_kluge) {
544 scr->scr_cfg.oscr_width = cfg.owidth =
545 cfg.fbwidth - cfg.width;
546 scr->scr_cfg.oscr_height = cfg.oheight =
547 cfg.fbheight - cfg.height;
548 }
549
550 /*
551 * Save a few fields for sti_describe_screen() later
552 */
553 scr->fbheight = cfg.fbheight;
554 scr->fbwidth = cfg.fbwidth;
555 scr->oheight = cfg.oheight;
556 scr->owidth = cfg.owidth;
557 memcpy(scr->name, cfg.name, sizeof(scr->name));
558
559 if ((error = sti_init(scr, STI_TEXTMODE | flags))) {
560 aprint_error(": cannot initialize (%d)\n", error);
561 goto fail;
562 }
563 #ifdef STIDEBUG
564 snprintb(buf, sizeof(buf), STI_INQCONF_BITS, cfg.attributes);
565 DPRINTF(("conf: bpp=%d planes=%d attr=%s\n"
566 "crt=0x%x:0x%x:0x%x hw=0x%x:0x%x:0x%x\n", cfg.bpp,
567 cfg.planes, buf,
568 ecfg.crt_config[0], ecfg.crt_config[1], ecfg.crt_config[2],
569 ecfg.crt_hw[0], ecfg.crt_hw[1], ecfg.crt_hw[2]));
570 #endif
571 scr->scr_bpp = cfg.bppu;
572
573 /*
574 * Although scr->scr_ecfg.current_monitor is not filled by
575 * sti_init() as expected, we can nevertheless walk the monitor
576 * list, if there is any, and if we find a mode matching our
577 * resolution, pick its font index.
578 */
579 if (dd->dd_montbl != 0) {
580 STI_ENABLE_ROM(rom->rom_softc);
581
582 for (i = 0; i < dd->dd_nmon; i++) {
583 u_int offs = dd->dd_montbl + 8 * i;
584 uint32_t m[2];
585 sti_mon_t mon = (void *)m;
586 if (rom->rom_devtype == STI_DEVTYPE1) {
587 m[0] = parseword(4 * offs);
588 m[1] = parseword(4 * (offs + 4));
589 } else {
590 bus_space_read_region_stream_4(memt, romh, offs,
591 (uint32_t *)mon, sizeof(*mon) / 4);
592 }
593
594 if (mon->width == scr->scr_cfg.scr_width &&
595 mon->height == scr->scr_cfg.scr_height) {
596 fontindex = mon->font;
597 break;
598 }
599 }
600
601 STI_DISABLE_ROM(rom->rom_softc);
602
603 DPRINTF(("font index: %d\n", fontindex));
604 }
605
606 if ((error = sti_fetchfonts(scr, &cfg, dd->dd_fntaddr, fontindex))) {
607 aprint_error(": cannot fetch fonts (%d)\n", error);
608 goto fail;
609 }
610
611 /*
612 * setup screen descriptions:
613 * figure number of fonts supported;
614 * allocate wscons structures;
615 * calculate dimensions.
616 */
617
618 scr->scr_wsd.name = "std";
619 scr->scr_wsd.ncols = cfg.width / scr->scr_curfont.width;
620 scr->scr_wsd.nrows = cfg.height / scr->scr_curfont.height;
621 scr->scr_wsd.textops = &sti_emulops;
622 scr->scr_wsd.fontwidth = scr->scr_curfont.width;
623 scr->scr_wsd.fontheight = scr->scr_curfont.height;
624 scr->scr_wsd.capabilities = WSSCREEN_REVERSE;
625
626 scr->scr_scrlist[0] = &scr->scr_wsd;
627 scr->scr_screenlist.nscreens = 1;
628 scr->scr_screenlist.screens = scr->scr_scrlist;
629
630 #ifndef SMALL_KERNEL
631 /*
632 * Decide which board-specific routines to use.
633 */
634
635 switch (dd->dd_grid[0]) {
636 case STI_DD_CRX:
637 scr->setupfb = ngle_elk_setupfb;
638 scr->putcmap = ngle_putcmap;
639
640 scr->reg10_value = 0x13601000;
641 if (scr->scr_bpp > 8)
642 scr->reg12_value = NGLE_BUFF1_CMAP3;
643 else
644 scr->reg12_value = NGLE_BUFF1_CMAP0;
645 scr->cmap_finish_register = NGLE_REG_1;
646 break;
647
648 case STI_DD_TIMBER:
649 scr->setupfb = ngle_timber_setupfb;
650 scr->putcmap = ngle_putcmap;
651
652 scr->reg10_value = 0x13602000;
653 scr->reg12_value = NGLE_BUFF1_CMAP0;
654 scr->cmap_finish_register = NGLE_REG_1;
655 break;
656
657 case STI_DD_ARTIST:
658 scr->setupfb = ngle_artist_setupfb;
659 scr->putcmap = ngle_putcmap;
660
661 scr->reg10_value = 0x13601000;
662 scr->reg12_value = NGLE_ARTIST_CMAP0;
663 scr->cmap_finish_register = NGLE_REG_26;
664 break;
665
666 case STI_DD_EG:
667 scr->setupfb = ngle_artist_setupfb;
668 scr->putcmap = ngle_putcmap;
669
670 scr->reg10_value = 0x13601000;
671 if (scr->scr_bpp > 8) {
672 scr->reg12_value = NGLE_BUFF1_CMAP3;
673 scr->cmap_finish_register = NGLE_REG_1;
674 } else {
675 scr->reg12_value = NGLE_ARTIST_CMAP0;
676 scr->cmap_finish_register = NGLE_REG_26;
677 }
678 break;
679
680 case STI_DD_GRX:
681 case STI_DD_CRX24:
682 case STI_DD_EVRX:
683 case STI_DD_3X2V:
684 case STI_DD_DUAL_CRX:
685 case STI_DD_HCRX:
686 case STI_DD_LEGO:
687 case STI_DD_SUMMIT:
688 case STI_DD_PINNACLE:
689 default:
690 scr->setupfb = NULL;
691 scr->putcmap =
692 rom->scment == NULL ? NULL : ngle_default_putcmap;
693 break;
694 }
695 #endif
696
697 return 0;
698
699 fail:
700 /* XXX free resources */
701 if (scr->scr_ecfg.addr != NULL) {
702 free(scr->scr_ecfg.addr, M_DEVBUF);
703 scr->scr_ecfg.addr = NULL;
704 }
705
706 return ENXIO;
707 }
708
709 void
710 sti_describe_screen(struct sti_softc *sc, struct sti_screen *scr)
711 {
712 struct sti_font *fp = &scr->scr_curfont;
713
714 aprint_normal("%s: %s, %dx%d frame buffer, %dx%dx%d display\n",
715 device_xname(sc->sc_dev), scr->name, scr->fbwidth, scr->fbheight,
716 scr->scr_cfg.scr_width, scr->scr_cfg.scr_height, scr->scr_bpp);
717
718 aprint_normal("%s: %dx%d font type %d, %d bpc, charset %d-%d\n",
719 device_xname(sc->sc_dev), fp->width, fp->height,
720 fp->type, fp->bpc, fp->first, fp->last);
721 }
722
723 void
724 sti_describe(struct sti_softc *sc)
725 {
726 struct sti_rom *rom = sc->sc_rom;
727 struct sti_dd *dd = &rom->rom_dd;
728
729 aprint_normal(": rev %d.%02d;%d, ID 0x%08X%08X\n",
730 dd->dd_grrev >> 4, dd->dd_grrev & 0xf,
731 dd->dd_lrrev, dd->dd_grid[0], dd->dd_grid[1]);
732
733 if (sc->sc_scr != NULL)
734 sti_describe_screen(sc, sc->sc_scr);
735 }
736
737 /*
738 * Final part of attachment. On hppa where we use the PDC console
739 * during autoconf, this has to be postponed until autoconf has
740 * completed.
741 */
742 void
743 sti_end_attach(struct sti_softc *sc)
744 {
745 struct sti_screen *scr = sc->sc_scr;
746
747 if (scr == NULL)
748 return;
749 #if NWSDISPLAY > 0
750 else {
751 struct wsemuldisplaydev_attach_args waa;
752 scr->scr_wsmode = WSDISPLAYIO_MODE_EMUL;
753
754 waa.console = sc->sc_flags & STI_CONSOLE ? 1 : 0;
755 waa.scrdata = &scr->scr_screenlist;
756 waa.accessops = &sti_accessops;
757 waa.accesscookie = scr;
758
759 /* attach as console if required */
760 if (waa.console && !ISSET(sc->sc_flags, STI_ATTACHED)) {
761 long defattr;
762
763 sti_alloc_attr(scr, 0, 0, 0, &defattr);
764 wsdisplay_cnattach(&scr->scr_wsd, scr,
765 0, scr->scr_wsd.nrows - 1, defattr);
766 sc->sc_flags |= STI_ATTACHED;
767 }
768
769 config_found(sc->sc_dev, &waa, wsemuldisplaydevprint);
770 }
771 #endif
772 }
773
774 u_int
775 sti_rom_size(bus_space_tag_t memt, bus_space_handle_t romh)
776 {
777 int devtype;
778 u_int romend;
779
780 devtype = bus_space_read_1(memt, romh, 3);
781 if (devtype == STI_DEVTYPE4) {
782 bus_space_read_region_stream_4(memt, romh, STI_DEV4_DD_ROMEND,
783 (uint32_t *)&romend, 1);
784 } else {
785 romend = parseword(STI_DEV1_DD_ROMEND);
786 }
787
788 DPRINTF(("%s: %08x (%08x)\n", __func__, romend, round_page(romend)));
789
790 return round_page(romend);
791 }
792
793 int
794 sti_fetchfonts(struct sti_screen *scr, struct sti_inqconfout *cfg,
795 uint32_t baseaddr, u_int fontindex)
796 {
797 struct sti_rom *rom = scr->scr_rom;
798 bus_space_tag_t memt = rom->memt;
799 bus_space_handle_t romh = rom->romh;
800 struct sti_font *fp = &scr->scr_curfont;
801 uint32_t addr;
802 int size;
803 #ifdef notyet
804 int uc;
805 struct {
806 struct sti_unpmvflags flags;
807 struct sti_unpmvin in;
808 struct sti_unpmvout out;
809 } a;
810 #endif
811
812 /*
813 * Get the first PROM font in memory
814 */
815
816 STI_ENABLE_ROM(rom->rom_softc);
817
818 rescan:
819 addr = baseaddr;
820 do {
821 if (rom->rom_devtype == STI_DEVTYPE1) {
822 fp->first = parseshort(addr + 0x00);
823 fp->last = parseshort(addr + 0x08);
824 fp->width = bus_space_read_1(memt, romh, addr + 0x13);
825 fp->height = bus_space_read_1(memt, romh, addr + 0x17);
826 fp->type = bus_space_read_1(memt, romh, addr + 0x1b);
827 fp->bpc = bus_space_read_1(memt, romh, addr + 0x1f);
828 fp->next = parseword(addr + 0x20);
829 fp->uheight= bus_space_read_1(memt, romh, addr + 0x33);
830 fp->uoffset= bus_space_read_1(memt, romh, addr + 0x37);
831 } else { /* STI_DEVTYPE4 */
832 bus_space_read_region_stream_4(memt, romh, addr,
833 (uint32_t *)fp, sizeof(struct sti_font) / 4);
834 }
835
836 #ifdef STIDEBUG
837 STI_DISABLE_ROM(rom->rom_softc);
838 DPRINTF(("%s: %dx%d font type %d, %d bpc, charset %d-%d\n",
839 device_xname(scr->scr_rom->rom_softc->sc_dev), fp->width,
840 fp->height, fp->type, fp->bpc, fp->first, fp->last));
841 STI_ENABLE_ROM(rom->rom_softc);
842 #endif
843
844 if (fontindex == 0) {
845 size = sizeof(struct sti_font) +
846 (fp->last - fp->first + 1) * fp->bpc;
847 if (rom->rom_devtype == STI_DEVTYPE1)
848 size *= 4;
849 scr->scr_romfont = malloc(size, M_DEVBUF, M_WAITOK);
850
851 bus_space_read_region_stream_4(memt, romh, addr,
852 (uint32_t *)scr->scr_romfont, size / 4);
853 break;
854 }
855
856 addr = baseaddr + fp->next;
857 fontindex--;
858 } while (fp->next != 0);
859
860 /*
861 * If our font index was bogus, we did not find the expected font.
862 * In this case, pick the first one and be done with it.
863 */
864 if (fp->next == 0 && scr->scr_romfont == NULL) {
865 fontindex = 0;
866 goto rescan;
867 }
868
869 STI_DISABLE_ROM(rom->rom_softc);
870
871 #ifdef notyet
872 /*
873 * If there is enough room in the off-screen framebuffer memory,
874 * display all the characters there in order to display them
875 * faster with blkmv operations rather than unpmv later on.
876 */
877 if (size <= cfg->fbheight *
878 (cfg->fbwidth - cfg->width - cfg->owidth)) {
879 memset(&a, 0, sizeof(a));
880 a.flags.flags = STI_UNPMVF_WAIT;
881 a.in.fg_colour = STI_COLOUR_WHITE;
882 a.in.bg_colour = STI_COLOUR_BLACK;
883 a.in.font_addr = scr->scr_romfont;
884
885 scr->scr_fontmaxcol = cfg->fbheight / fp->height;
886 scr->scr_fontbase = cfg->width + cfg->owidth;
887 for (uc = fp->first; uc <= fp->last; uc++) {
888 a.in.x = ((uc - fp->first) / scr->scr_fontmaxcol) *
889 fp->width + scr->scr_fontbase;
890 a.in.y = ((uc - fp->first) % scr->scr_fontmaxcol) *
891 fp->height;
892 a.in.index = uc;
893
894 (*scr->unpmv)(&a.flags, &a.in, &a.out, &scr->scr_cfg);
895 if (a.out.errno) {
896 aprint_error_dev(sc->sc_dev, "unpmv %d "
897 "returned %d\n", uc, a.out.errno);
898 return 0;
899 }
900 }
901
902 free(scr->scr_romfont, M_DEVBUF);
903 scr->scr_romfont = NULL;
904 }
905 #endif
906
907 return 0;
908 }
909
910 /*
911 * Wrappers around STI code pointers
912 */
913
914 int
915 sti_init(struct sti_screen *scr, int mode)
916 {
917 struct sti_rom *rom = scr->scr_rom;
918 struct {
919 struct sti_initflags flags;
920 struct sti_initin in;
921 struct sti_einitin ein;
922 struct sti_initout out;
923 } a;
924
925 KASSERT(rom != NULL);
926 memset(&a, 0, sizeof(a));
927
928 a.flags.flags = STI_INITF_WAIT | STI_INITF_EBET;
929 if ((mode & STI_TEXTMODE) != 0) {
930 a.flags.flags |= STI_INITF_TEXT | STI_INITF_CMB |
931 STI_INITF_PBET | STI_INITF_PBETI | STI_INITF_ICMT;
932 } else {
933 a.flags.flags |= STI_INITF_NTEXT;
934 }
935 if ((mode & STI_CLEARSCR) != 0)
936 a.flags.flags |= STI_INITF_CLEAR;
937
938 a.in.text_planes = 1;
939 a.in.ext_in = &a.ein;
940
941 DPRINTF(("%s: init,%p(%x, %p, %p, %p)\n",
942 device_xname(rom->rom_softc->sc_dev), rom->init, a.flags.flags,
943 &a.in, &a.out, &scr->scr_cfg));
944
945 (*rom->init)(&a.flags, &a.in, &a.out, &scr->scr_cfg);
946
947 if (a.out.text_planes != a.in.text_planes)
948 return -1; /* not colliding with sti errno values */
949 return a.out.errno;
950 }
951
952 int
953 sti_inqcfg(struct sti_screen *scr, struct sti_inqconfout *out)
954 {
955 struct sti_rom *rom = scr->scr_rom;
956 struct {
957 struct sti_inqconfflags flags;
958 struct sti_inqconfin in;
959 } a;
960
961 memset(&a, 0, sizeof(a));
962
963 a.flags.flags = STI_INQCONFF_WAIT;
964 (*rom->inqconf)(&a.flags, &a.in, out, &scr->scr_cfg);
965
966 return out->errno;
967 }
968
969 void
970 sti_bmove(struct sti_screen *scr, int x1, int y1, int x2, int y2, int h, int w,
971 enum sti_bmove_funcs f)
972 {
973 struct sti_rom *rom = scr->scr_rom;
974 struct {
975 struct sti_blkmvflags flags;
976 struct sti_blkmvin in;
977 struct sti_blkmvout out;
978 } a;
979
980 memset(&a, 0, sizeof(a));
981
982 a.flags.flags = STI_BLKMVF_WAIT;
983 switch (f) {
984 case bmf_clear:
985 a.flags.flags |= STI_BLKMVF_CLR;
986 a.in.bg_colour = STI_COLOUR_BLACK;
987 break;
988 case bmf_underline:
989 case bmf_copy:
990 a.in.fg_colour = STI_COLOUR_WHITE;
991 a.in.bg_colour = STI_COLOUR_BLACK;
992 break;
993 case bmf_invert:
994 a.flags.flags |= STI_BLKMVF_COLR;
995 a.in.fg_colour = STI_COLOUR_BLACK;
996 a.in.bg_colour = STI_COLOUR_WHITE;
997 break;
998 }
999 a.in.srcx = x1;
1000 a.in.srcy = y1;
1001 a.in.dstx = x2;
1002 a.in.dsty = y2;
1003 a.in.height = h;
1004 a.in.width = w;
1005
1006 (*rom->blkmv)(&a.flags, &a.in, &a.out, &scr->scr_cfg);
1007 #ifdef STIDEBUG
1008 if (a.out.errno)
1009 printf("%s: blkmv returned %d\n",
1010 device_xname(rom->rom_softc->sc_dev), a.out.errno);
1011 #endif
1012 }
1013
1014 int
1015 sti_setcment(struct sti_screen *scr, u_int i, u_char r, u_char g, u_char b)
1016 {
1017 struct sti_rom *rom = scr->scr_rom;
1018 struct {
1019 struct sti_scmentflags flags;
1020 struct sti_scmentin in;
1021 struct sti_scmentout out;
1022 } a;
1023
1024 memset(&a, 0, sizeof(a));
1025
1026 a.flags.flags = STI_SCMENTF_WAIT;
1027 a.in.entry = i;
1028 a.in.value = (r << 16) | (g << 8) | b;
1029
1030 (*rom->scment)(&a.flags, &a.in, &a.out, &scr->scr_cfg);
1031
1032 return a.out.errno;
1033 }
1034
1035 /*
1036 * wsdisplay accessops
1037 */
1038 int
1039 sti_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l)
1040 {
1041 struct sti_screen *scr = (struct sti_screen *)v;
1042 struct wsdisplay_fbinfo *wdf;
1043 struct wsdisplay_cmap *cmapp;
1044 u_int mode, idx, count;
1045 int ret;
1046
1047 ret = 0;
1048 switch (cmd) {
1049 case WSDISPLAYIO_GMODE:
1050 *(u_int *)data = scr->scr_wsmode;
1051 break;
1052
1053 case WSDISPLAYIO_SMODE:
1054 mode = *(u_int *)data;
1055 switch (mode) {
1056 case WSDISPLAYIO_MODE_EMUL:
1057 if (scr->scr_wsmode != WSDISPLAYIO_MODE_EMUL)
1058 ret = sti_init(scr, STI_TEXTMODE);
1059 break;
1060 case WSDISPLAYIO_MODE_DUMBFB:
1061 if (scr->scr_wsmode != WSDISPLAYIO_MODE_DUMBFB) {
1062 sti_init(scr, 0);
1063 if (scr->setupfb != NULL)
1064 scr->setupfb(scr);
1065 else
1066 #if 0
1067 ret = sti_init(scr, STI_FBMODE);
1068 #else
1069 ret = EINVAL;
1070 #endif
1071 }
1072 break;
1073 case WSDISPLAYIO_MODE_MAPPED:
1074 default:
1075 ret = EINVAL;
1076 break;
1077 }
1078 if (ret == 0)
1079 scr->scr_wsmode = mode;
1080 break;
1081
1082 case WSDISPLAYIO_GTYPE:
1083 *(u_int *)data = WSDISPLAY_TYPE_STI;
1084 break;
1085
1086 case WSDISPLAYIO_GINFO:
1087 wdf = (struct wsdisplay_fbinfo *)data;
1088 wdf->height = scr->scr_cfg.scr_height;
1089 wdf->width = scr->scr_cfg.scr_width;
1090 wdf->depth = scr->scr_bpp;
1091 if (scr->putcmap == NULL || scr->scr_bpp > 8)
1092 wdf->cmsize = 0;
1093 else
1094 wdf->cmsize = STI_NCMAP;
1095 break;
1096
1097 case WSDISPLAYIO_LINEBYTES:
1098 if (scr->scr_bpp > 8)
1099 *(u_int *)data = scr->scr_cfg.fb_width * 4;
1100 else
1101 *(u_int *)data = scr->scr_cfg.fb_width;
1102 break;
1103
1104 case WSDISPLAYIO_GETCMAP:
1105 if (scr->putcmap == NULL || scr->scr_bpp > 8)
1106 return ENODEV;
1107 cmapp = (struct wsdisplay_cmap *)data;
1108 idx = cmapp->index;
1109 count = cmapp->count;
1110 if (idx >= STI_NCMAP || count > STI_NCMAP - idx)
1111 return EINVAL;
1112 if ((ret = copyout(&scr->scr_rcmap[idx], cmapp->red, count)))
1113 break;
1114 if ((ret = copyout(&scr->scr_gcmap[idx], cmapp->green, count)))
1115 break;
1116 if ((ret = copyout(&scr->scr_bcmap[idx], cmapp->blue, count)))
1117 break;
1118 break;
1119
1120 case WSDISPLAYIO_PUTCMAP:
1121 if (scr->putcmap == NULL || scr->scr_bpp > 8)
1122 return ENODEV;
1123 if (scr->scr_wsmode == WSDISPLAYIO_MODE_EMUL) {
1124 /*
1125 * The hardware palette settings are handled by
1126 * the STI ROM in STI_TEXTMODE and changing cmap
1127 * could cause mangled text colors at least on CRX.
1128 * Updating CMAP in EMUL mode isn't expected anyway
1129 * so just ignore it.
1130 */
1131 return 0;
1132 }
1133 cmapp = (struct wsdisplay_cmap *)data;
1134 idx = cmapp->index;
1135 count = cmapp->count;
1136 if (idx >= STI_NCMAP || count > STI_NCMAP - idx)
1137 return EINVAL;
1138 if ((ret = copyin(cmapp->red, &scr->scr_rcmap[idx], count)))
1139 break;
1140 if ((ret = copyin(cmapp->green, &scr->scr_gcmap[idx], count)))
1141 break;
1142 if ((ret = copyin(cmapp->blue, &scr->scr_bcmap[idx], count)))
1143 break;
1144 ret = scr->putcmap(scr, idx, count);
1145 break;
1146
1147 case WSDISPLAYIO_SVIDEO:
1148 case WSDISPLAYIO_GVIDEO:
1149 case WSDISPLAYIO_GCURPOS:
1150 case WSDISPLAYIO_SCURPOS:
1151 case WSDISPLAYIO_GCURMAX:
1152 case WSDISPLAYIO_GCURSOR:
1153 case WSDISPLAYIO_SCURSOR:
1154 default:
1155 return ENOTTY; /* not supported yet */
1156 }
1157
1158 return ret;
1159 }
1160
1161 paddr_t
1162 sti_mmap(void *v, void *vs, off_t offset, int prot)
1163 {
1164 struct sti_screen *scr = (struct sti_screen *)v;
1165 struct sti_rom *rom = scr->scr_rom;
1166 paddr_t pa;
1167
1168 if ((offset & PAGE_MASK) != 0)
1169 return -1;
1170
1171 if (offset < 0 || offset >= scr->fblen)
1172 return -1;
1173
1174 if (scr->scr_wsmode != WSDISPLAYIO_MODE_DUMBFB)
1175 return -1;
1176
1177 pa = bus_space_mmap(rom->memt, scr->fbaddr, offset, prot,
1178 BUS_SPACE_MAP_LINEAR);
1179
1180 if (pa == -1)
1181 pa = scr->fbaddr + offset;
1182
1183 return pa;
1184 }
1185
1186 int
1187 sti_alloc_screen(void *v, const struct wsscreen_descr *type, void **cookiep,
1188 int *cxp, int *cyp, long *defattr)
1189 {
1190 struct sti_screen *scr = (struct sti_screen *)v;
1191
1192 if (scr->scr_nscreens > 0)
1193 return ENOMEM;
1194
1195 *cookiep = scr;
1196 *cxp = 0;
1197 *cyp = 0;
1198 sti_alloc_attr(scr, 0, 0, 0, defattr);
1199 scr->scr_nscreens++;
1200 return 0;
1201 }
1202
1203 void
1204 sti_free_screen(void *v, void *cookie)
1205 {
1206 struct sti_screen *scr = (struct sti_screen *)v;
1207
1208 scr->scr_nscreens--;
1209 }
1210
1211 int
1212 sti_show_screen(void *v, void *cookie, int waitok, void (*cb)(void *, int, int),
1213 void *cbarg)
1214 {
1215 #if 0
1216 struct sti_screen *scr = (struct sti_screen *)v;
1217 #endif
1218
1219 return 0;
1220 }
1221
1222 int
1223 sti_load_font(void *v, void *cookie, struct wsdisplay_font *font)
1224 {
1225 #if 0
1226 struct sti_screen *scr = (struct sti_screen *)v;
1227 #endif
1228
1229 return -1;
1230 }
1231
1232 /*
1233 * wsdisplay emulops
1234 */
1235 void
1236 sti_cursor(void *v, int on, int row, int col)
1237 {
1238 struct sti_screen *scr = (struct sti_screen *)v;
1239 struct sti_font *fp = &scr->scr_curfont;
1240
1241 sti_bmove(scr,
1242 col * fp->width, row * fp->height,
1243 col * fp->width, row * fp->height,
1244 fp->height, fp->width, bmf_invert);
1245 }
1246
1247 /*
1248 * ISO 8859-1 part of Unicode to HP Roman font index conversion array.
1249 */
1250 static const uint8_t
1251 sti_unitoroman[0x100 - 0xa0] = {
1252 0xa0, 0xb8, 0xbf, 0xbb, 0xba, 0xbc, 0, 0xbd,
1253 0xab, 0, 0xf9, 0xfb, 0, 0xf6, 0, 0xb0,
1254
1255 0xb3, 0xfe, 0, 0, 0xa8, 0xf3, 0xf4, 0xf2,
1256 0, 0, 0xfa, 0xfd, 0xf7, 0xf8, 0, 0xb9,
1257
1258 0xa1, 0xe0, 0xa2, 0xe1, 0xd8, 0xd0, 0xd3, 0xb4,
1259 0xa3, 0xdc, 0xa4, 0xa5, 0xe6, 0xe5, 0xa6, 0xa7,
1260
1261 0xe3, 0xb6, 0xe8, 0xe7, 0xdf, 0xe9, 0xda, 0,
1262 0xd2, 0xad, 0xed, 0xae, 0xdb, 0xb1, 0xf0, 0xde,
1263
1264 0xc8, 0xc4, 0xc0, 0xe2, 0xcc, 0xd4, 0xd7, 0xb5,
1265 0xc9, 0xc5, 0xc1, 0xcd, 0xd9, 0xd5, 0xd1, 0xdd,
1266
1267 0xe4, 0xb7, 0xca, 0xc6, 0xc2, 0xea, 0xce, 0,
1268 0xd6, 0xcb, 0xc7, 0xc3, 0xcf, 0xb2, 0xf1, 0xef
1269 };
1270
1271 int
1272 sti_mapchar(void *v, int uni, u_int *index)
1273 {
1274 struct sti_screen *scr = (struct sti_screen *)v;
1275 struct sti_font *fp = &scr->scr_curfont;
1276 int c;
1277
1278 switch (fp->type) {
1279 case STI_FONT_HPROMAN8:
1280 if (uni >= 0x80 && uni < 0xa0)
1281 c = -1;
1282 else if (uni >= 0xa0 && uni < 0x100) {
1283 c = (int)sti_unitoroman[uni - 0xa0];
1284 if (c == 0)
1285 c = -1;
1286 } else
1287 c = uni;
1288 break;
1289 default:
1290 c = uni;
1291 break;
1292 }
1293
1294 if (c == -1 || c < fp->first || c > fp->last) {
1295 *index = ' ';
1296 return 0;
1297 }
1298
1299 *index = c;
1300 return 5;
1301 }
1302
1303 void
1304 sti_putchar(void *v, int row, int col, u_int uc, long attr)
1305 {
1306 struct sti_screen *scr = (struct sti_screen *)v;
1307 struct sti_rom *rom = scr->scr_rom;
1308 struct sti_font *fp = &scr->scr_curfont;
1309 int bg, fg;
1310
1311 fg = WSATTR_UNPACK_FG(attr);
1312 bg = WSATTR_UNPACK_BG(attr);
1313
1314 if (scr->scr_romfont != NULL) {
1315 /*
1316 * Font is in memory, use unpmv
1317 */
1318 struct {
1319 struct sti_unpmvflags flags;
1320 struct sti_unpmvin in;
1321 struct sti_unpmvout out;
1322 } a;
1323
1324 memset(&a, 0, sizeof(a));
1325
1326 a.flags.flags = STI_UNPMVF_WAIT;
1327 a.in.fg_colour = fg;
1328 a.in.bg_colour = bg;
1329 a.in.x = col * fp->width;
1330 a.in.y = row * fp->height;
1331 a.in.font_addr = scr->scr_romfont;
1332 a.in.index = uc;
1333
1334 (*rom->unpmv)(&a.flags, &a.in, &a.out, &scr->scr_cfg);
1335 } else {
1336 /*
1337 * Font is in frame buffer, use blkmv
1338 */
1339 struct {
1340 struct sti_blkmvflags flags;
1341 struct sti_blkmvin in;
1342 struct sti_blkmvout out;
1343 } a;
1344
1345 memset(&a, 0, sizeof(a));
1346
1347 a.flags.flags = STI_BLKMVF_WAIT;
1348 a.in.fg_colour = fg;
1349 a.in.bg_colour = bg;
1350
1351 a.in.srcx = ((uc - fp->first) / scr->scr_fontmaxcol) *
1352 fp->width + scr->scr_fontbase;
1353 a.in.srcy = ((uc - fp->first) % scr->scr_fontmaxcol) *
1354 fp->height;
1355 a.in.dstx = col * fp->width;
1356 a.in.dsty = row * fp->height;
1357 a.in.height = fp->height;
1358 a.in.width = fp->width;
1359
1360 (*rom->blkmv)(&a.flags, &a.in, &a.out, &scr->scr_cfg);
1361 }
1362 }
1363
1364 void
1365 sti_copycols(void *v, int row, int srccol, int dstcol, int ncols)
1366 {
1367 struct sti_screen *scr = (struct sti_screen *)v;
1368 struct sti_font *fp = &scr->scr_curfont;
1369
1370 sti_bmove(scr,
1371 srccol * fp->width, row * fp->height,
1372 dstcol * fp->width, row * fp->height,
1373 fp->height, ncols * fp->width, bmf_copy);
1374 }
1375
1376 void
1377 sti_erasecols(void *v, int row, int startcol, int ncols, long attr)
1378 {
1379 struct sti_screen *scr = (struct sti_screen *)v;
1380 struct sti_font *fp = &scr->scr_curfont;
1381
1382 sti_bmove(scr,
1383 startcol * fp->width, row * fp->height,
1384 startcol * fp->width, row * fp->height,
1385 fp->height, ncols * fp->width, bmf_clear);
1386 }
1387
1388 void
1389 sti_copyrows(void *v, int srcrow, int dstrow, int nrows)
1390 {
1391 struct sti_screen *scr = (struct sti_screen *)v;
1392 struct sti_font *fp = &scr->scr_curfont;
1393
1394 sti_bmove(scr, 0, srcrow * fp->height, 0, dstrow * fp->height,
1395 nrows * fp->height, scr->scr_cfg.scr_width, bmf_copy);
1396 }
1397
1398 void
1399 sti_eraserows(void *v, int srcrow, int nrows, long attr)
1400 {
1401 struct sti_screen *scr = (struct sti_screen *)v;
1402 struct sti_font *fp = &scr->scr_curfont;
1403
1404 sti_bmove(scr, 0, srcrow * fp->height, 0, srcrow * fp->height,
1405 nrows * fp->height, scr->scr_cfg.scr_width, bmf_clear);
1406 }
1407
1408 int
1409 sti_alloc_attr(void *v, int fg, int bg, int flags, long *pattr)
1410 {
1411 #if 0
1412 struct sti_screen *scr = (struct sti_screen *)v;
1413 #endif
1414
1415 if ((flags & (WSATTR_HILIT | WSATTR_BLINK |
1416 WSATTR_UNDERLINE | WSATTR_WSCOLORS)) != 0)
1417 return EINVAL;
1418 if ((flags & WSATTR_REVERSE) != 0) {
1419 fg = STI_COLOUR_BLACK;
1420 bg = STI_COLOUR_WHITE;
1421 } else {
1422 fg = STI_COLOUR_WHITE;
1423 bg = STI_COLOUR_BLACK;
1424 }
1425
1426 *pattr = WSATTR_PACK(fg, bg, flags);
1427 return 0;
1428 }
1429
1430 /*
1431 * Early console support. Only used on hp300, currently
1432 */
1433 int
1434 sti_cnattach(struct sti_rom *rom, struct sti_screen *scr, bus_space_tag_t memt,
1435 bus_addr_t *bases, u_int codebase)
1436 {
1437 bus_space_handle_t romh;
1438 u_int romend;
1439 int error;
1440 long defattr;
1441
1442 if ((error = bus_space_map(memt, bases[0], PAGE_SIZE, 0, &romh)) != 0)
1443 return error;
1444
1445 /*
1446 * Compute real PROM size
1447 */
1448 romend = sti_rom_size(memt, romh);
1449
1450 bus_space_unmap(memt, romh, PAGE_SIZE);
1451
1452 if ((error = bus_space_map(memt, bases[0], romend, 0, &romh)) != 0)
1453 return error;
1454
1455 bases[0] = romh;
1456 if (sti_rom_setup(rom, memt, memt, romh, bases, codebase) != 0)
1457 return -1;
1458 scr->scr_rom = rom;
1459 if (sti_screen_setup(scr, STI_CLEARSCR) != 0)
1460 return -1;
1461
1462 sti_alloc_attr(scr, 0, 0, 0, &defattr);
1463 wsdisplay_cnattach(&scr->scr_wsd, scr, 0, 0, defattr);
1464
1465 return 0;
1466 }
1467
1468 int
1469 ngle_default_putcmap(struct sti_screen *scr, u_int idx, u_int count)
1470 {
1471 int i, ret;
1472
1473 for (i = idx + count - 1; i >= (int)idx; i--)
1474 if ((ret = sti_setcment(scr, i, scr->scr_rcmap[i],
1475 scr->scr_gcmap[i], scr->scr_bcmap[i])))
1476 return EINVAL;
1477
1478 return 0;
1479 }
1480
1481 #ifndef SMALL_KERNEL
1482
1483 void ngle_setup_hw(bus_space_tag_t, bus_space_handle_t);
1484 void ngle_setup_fb(bus_space_tag_t, bus_space_handle_t, uint32_t);
1485 void ngle_setup_attr_planes(struct sti_screen *scr);
1486 void ngle_setup_bt458(struct sti_screen *scr);
1487
1488 #define ngle_bt458_write(memt, memh, r, v) \
1489 bus_space_write_4(memt, memh, NGLE_REG_RAMDAC + ((r) << 2), (v) << 24)
1490
1491 void
1492 ngle_artist_setupfb(struct sti_screen *scr)
1493 {
1494 struct sti_rom *rom = scr->scr_rom;
1495 bus_space_tag_t memt = rom->memt;
1496 bus_space_handle_t memh = rom->regh[2];
1497
1498 ngle_setup_bt458(scr);
1499
1500 ngle_setup_hw(memt, memh);
1501 ngle_setup_fb(memt, memh, scr->reg10_value);
1502
1503 ngle_setup_attr_planes(scr);
1504
1505 ngle_setup_hw(memt, memh);
1506 bus_space_write_4(memt, memh, NGLE_REG_21,
1507 bus_space_read_4(memt, memh, NGLE_REG_21) | 0x0a000000);
1508 bus_space_write_4(memt, memh, NGLE_REG_27,
1509 bus_space_read_4(memt, memh, NGLE_REG_27) | 0x00800000);
1510 }
1511
1512 void
1513 ngle_elk_setupfb(struct sti_screen *scr)
1514 {
1515 struct sti_rom *rom = scr->scr_rom;
1516 bus_space_tag_t memt = rom->memt;
1517 bus_space_handle_t memh = rom->regh[2];
1518
1519 ngle_setup_bt458(scr);
1520
1521 ngle_setup_hw(memt, memh);
1522 ngle_setup_fb(memt, memh, scr->reg10_value);
1523
1524 ngle_setup_attr_planes(scr);
1525
1526 ngle_setup_hw(memt, memh);
1527 /* enable overlay planes in Bt458 command register */
1528 ngle_bt458_write(memt, memh, 0x0c, 0x06);
1529 ngle_bt458_write(memt, memh, 0x0e, 0x43);
1530 }
1531
1532 void
1533 ngle_timber_setupfb(struct sti_screen *scr)
1534 {
1535 struct sti_rom *rom = scr->scr_rom;
1536 bus_space_tag_t memt = rom->memt;
1537 bus_space_handle_t memh = rom->regh[2];
1538
1539 ngle_setup_bt458(scr);
1540
1541 ngle_setup_hw(memt, memh);
1542 /* enable overlay planes in Bt458 command register */
1543 ngle_bt458_write(memt, memh, 0x0c, 0x06);
1544 ngle_bt458_write(memt, memh, 0x0e, 0x43);
1545 }
1546
1547 void
1548 ngle_setup_bt458(struct sti_screen *scr)
1549 {
1550 struct sti_rom *rom = scr->scr_rom;
1551 bus_space_tag_t memt = rom->memt;
1552 bus_space_handle_t memh = rom->regh[2];
1553
1554 ngle_setup_hw(memt, memh);
1555 /* set Bt458 read mask register to all planes */
1556 ngle_bt458_write(memt, memh, 0x08, 0x04);
1557 ngle_bt458_write(memt, memh, 0x0a, 0xff);
1558 }
1559
1560 void
1561 ngle_setup_attr_planes(struct sti_screen *scr)
1562 {
1563 struct sti_rom *rom = scr->scr_rom;
1564 bus_space_tag_t memt = rom->memt;
1565 bus_space_handle_t memh = rom->regh[2];
1566
1567 ngle_setup_hw(memt, memh);
1568 bus_space_write_4(memt, memh, NGLE_REG_11, 0x2ea0d000);
1569 bus_space_write_4(memt, memh, NGLE_REG_14, 0x23000302);
1570 bus_space_write_4(memt, memh, NGLE_REG_12, scr->reg12_value);
1571 bus_space_write_4(memt, memh, NGLE_REG_8, 0xffffffff);
1572
1573 bus_space_write_4(memt, memh, NGLE_REG_6, 0x00000000);
1574 bus_space_write_4(memt, memh, NGLE_REG_9,
1575 (scr->scr_cfg.scr_width << 16) | scr->scr_cfg.scr_height);
1576 bus_space_write_4(memt, memh, NGLE_REG_6, 0x05000000);
1577 bus_space_write_4(memt, memh, NGLE_REG_9, 0x00040001);
1578
1579 ngle_setup_hw(memt, memh);
1580 bus_space_write_4(memt, memh, NGLE_REG_12, 0x00000000);
1581
1582 ngle_setup_fb(memt, memh, scr->reg10_value);
1583 }
1584
1585 int
1586 ngle_putcmap(struct sti_screen *scr, u_int idx, u_int count)
1587 {
1588 struct sti_rom *rom = scr->scr_rom;
1589 bus_space_tag_t memt = rom->memt;
1590 bus_space_handle_t memh = rom->regh[2];
1591 uint8_t *r, *g, *b;
1592 uint32_t cmap_finish;
1593
1594 if (scr->scr_bpp > 8)
1595 cmap_finish = 0x83000100;
1596 else
1597 cmap_finish = 0x80000100;
1598
1599 r = scr->scr_rcmap + idx;
1600 g = scr->scr_gcmap + idx;
1601 b = scr->scr_bcmap + idx;
1602
1603 ngle_setup_hw(memt, memh);
1604 bus_space_write_4(memt, memh, NGLE_REG_10, 0xbbe0f000);
1605 bus_space_write_4(memt, memh, NGLE_REG_14, 0x03000300);
1606 bus_space_write_4(memt, memh, NGLE_REG_13, 0xffffffff);
1607
1608 while (count-- != 0) {
1609 ngle_setup_hw(memt, memh);
1610 bus_space_write_4(memt, memh, NGLE_REG_3, 0x400 | (idx << 2));
1611 bus_space_write_4(memt, memh, NGLE_REG_4,
1612 (*r << 16) | (*g << 8) | *b);
1613
1614 idx++;
1615 r++, g++, b++;
1616 }
1617
1618 bus_space_write_4(memt, memh, NGLE_REG_2, 0x400);
1619 bus_space_write_4(memt, memh, scr->cmap_finish_register, cmap_finish);
1620 ngle_setup_fb(memt, memh, scr->reg10_value);
1621
1622
1623 return 0;
1624 }
1625
1626 void
1627 ngle_setup_hw(bus_space_tag_t memt, bus_space_handle_t memh)
1628 {
1629 uint8_t stat;
1630
1631 do {
1632 stat = bus_space_read_1(memt, memh, NGLE_REG_15b0);
1633 if (stat == 0)
1634 stat = bus_space_read_1(memt, memh, NGLE_REG_15b0);
1635 } while (stat != 0);
1636 }
1637
1638 void
1639 ngle_setup_fb(bus_space_tag_t memt, bus_space_handle_t memh, uint32_t reg10)
1640 {
1641
1642 ngle_setup_hw(memt, memh);
1643 bus_space_write_4(memt, memh, NGLE_REG_10, reg10);
1644 bus_space_write_4(memt, memh, NGLE_REG_14, 0x83000300);
1645 ngle_setup_hw(memt, memh);
1646 bus_space_write_1(memt, memh, NGLE_REG_16b1, 1);
1647 }
1648 #endif /* SMALL_KERNEL */
1649