fb_sbdio.c revision 1.14
1 /* $NetBSD: fb_sbdio.c,v 1.14 2014/09/21 15:50:35 christos Exp $ */ 2 3 /*- 4 * Copyright (c) 2004, 2005 The NetBSD Foundation, Inc. 5 * All rights reserved. 6 * 7 * This code is derived from software contributed to The NetBSD Foundation 8 * by UCHIYAMA Yasushi. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 19 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 * POSSIBILITY OF SUCH DAMAGE. 30 */ 31 32 #define WIRED_FB_TLB 33 34 #include <sys/cdefs.h> 35 __KERNEL_RCSID(0, "$NetBSD: fb_sbdio.c,v 1.14 2014/09/21 15:50:35 christos Exp $"); 36 37 #include <sys/param.h> 38 #include <sys/systm.h> 39 #include <sys/malloc.h> 40 #include <dev/cons.h> 41 42 #include <uvm/uvm_extern.h> /* pmap function to remap FB */ 43 44 #include <dev/wscons/wsconsio.h> 45 #include <dev/wscons/wsdisplayvar.h> 46 #include <dev/wsfont/wsfont.h> 47 #include <dev/rasops/rasops.h> 48 49 #include <mips/pte.h> 50 51 #include <machine/locore.h> 52 #include <machine/sbdiovar.h> 53 54 #include <machine/gareg.h> 55 #include <machine/gavar.h> 56 57 #include <machine/vmparam.h> 58 #include <machine/wired_map.h> 59 60 61 struct fb_softc { 62 device_t sc_dev; 63 struct rasops_info *sc_ri; 64 struct ga *sc_ga; 65 int sc_nscreens; 66 }; 67 68 int fb_sbdio_match(device_t, cfdata_t, void *); 69 void fb_sbdio_attach(device_t, device_t, void *); 70 71 CFATTACH_DECL_NEW(fb_sbdio, sizeof(struct fb_softc), 72 fb_sbdio_match, fb_sbdio_attach, NULL, NULL); 73 74 int _fb_ioctl(void *, void *, u_long, void *, int, struct lwp *); 75 paddr_t _fb_mmap(void *, void *, off_t, int); 76 int _fb_alloc_screen(void *, const struct wsscreen_descr *, void **, 77 int *, int *, long *); 78 void _fb_free_screen(void *, void *); 79 int _fb_show_screen(void *, void *, int, void (*)(void *, int, int), void *); 80 void _fb_pollc(void *, int); 81 void fb_common_init(struct rasops_info *, struct ga *); 82 int fb_sbdio_cnattach(uint32_t, uint32_t, int); 83 void fb_pmap_enter(paddr_t, paddr_t, vaddr_t *, vaddr_t *); 84 85 struct wsscreen_descr _fb_std_screen = { 86 "std", 0, 0, 87 0, /* textops */ 88 0, 0, 89 0 90 }; 91 92 const struct wsscreen_descr *_fb_screen_table[] = { 93 &_fb_std_screen, 94 }; 95 96 struct wsscreen_list _fb_screen_list = { 97 .nscreens = 98 sizeof(_fb_screen_table) / sizeof(_fb_screen_table[0]), 99 .screens = _fb_screen_table 100 }; 101 102 struct wsdisplay_accessops _fb_accessops = { 103 .ioctl = _fb_ioctl, 104 .mmap = _fb_mmap, 105 .alloc_screen = _fb_alloc_screen, 106 .free_screen = _fb_free_screen, 107 .show_screen = _fb_show_screen, 108 .load_font = 0, 109 .pollc = _fb_pollc 110 }; 111 112 /* console stuff */ 113 static struct rasops_info fb_console_ri; 114 static struct ga fb_console_ga; 115 static paddr_t fb_consaddr; 116 117 118 int 119 fb_sbdio_match(device_t parent, cfdata_t cf, void *aux) 120 { 121 struct sbdio_attach_args *sa = aux; 122 123 return strcmp(sa->sa_name, "fb") ? 0 : 1; 124 } 125 126 void 127 fb_sbdio_attach(device_t parent, device_t self, void *aux) 128 { 129 struct fb_softc *sc = device_private(self); 130 struct sbdio_attach_args *sa = aux; 131 struct wsemuldisplaydev_attach_args wa; 132 struct rasops_info *ri; 133 struct ga *ga; 134 vaddr_t memva, regva; 135 int console; 136 137 sc->sc_dev = self; 138 aprint_normal("\n"); 139 140 console = (sa->sa_addr1 == fb_consaddr); 141 if (console) { 142 /* already initialized in fb_cnattach() */ 143 sc->sc_ri = ri = &fb_console_ri; 144 ri->ri_flg &= ~RI_NO_AUTO; 145 sc->sc_ga = &fb_console_ga; 146 sc->sc_nscreens = 1; 147 } else { 148 ri = malloc(sizeof(struct rasops_info), M_DEVBUF, 149 M_NOWAIT | M_ZERO); 150 if (ri == NULL) { 151 printf(":can't allocate rasops memory\n"); 152 return; 153 } 154 ga = malloc(sizeof(struct ga), M_DEVBUF, M_NOWAIT | M_ZERO); 155 if (ga == NULL) { 156 printf(":can't allocate ga memory\n"); 157 free(ri, M_DEVBUF); 158 return; 159 } 160 ga->reg_paddr = sa->sa_addr2; 161 ga->flags = sa->sa_flags; 162 fb_pmap_enter(sa->sa_addr1, sa->sa_addr2, 163 &memva, ®va); 164 ri->ri_bits = (void *)memva; 165 ga->reg_addr = regva; 166 fb_common_init(ri, ga); 167 sc->sc_ri = ri; 168 sc->sc_ga = ga; 169 } 170 171 wa.console = console; 172 wa.scrdata = &_fb_screen_list; 173 wa.accessops = &_fb_accessops; 174 wa.accesscookie = (void *)sc; 175 176 config_found(self, &wa, wsdisplaydevprint); 177 } 178 179 void 180 fb_common_init(struct rasops_info *ri, struct ga *ga) 181 { 182 int ga_active, cookie; 183 184 /* XXX */ 185 ga_active = 0; 186 if (ga->flags == 0x0000 || ga->flags == 0x0001) 187 ga_active = ga_init(ga); 188 189 /* 190 * TR2 IPL CLUT. 191 * 0 black 192 * 1 red 193 * 2 green 194 * 4 blue 195 * 8 yellow 196 * 16 cyan 197 * 32 magenta 198 * 64 light gray 199 * 128 dark gray 200 * 255 white 201 * other black 202 * When CLUT isn't initialized for NetBSD, use black-red pair. 203 */ 204 ri->ri_flg = RI_CENTER | RI_CLEAR; 205 if (!ga_active) 206 ri->ri_flg |= RI_FORCEMONO; 207 if (ri == &fb_console_ri) 208 ri->ri_flg |= RI_NO_AUTO; 209 210 ri->ri_depth = 8; 211 ri->ri_width = 1280; 212 ri->ri_height = 1024; 213 ri->ri_stride = 2048; 214 ri->ri_hw = (void *)ga; 215 216 wsfont_init(); 217 /* prefer 12 pixel wide font */ 218 cookie = wsfont_find(NULL, 12, 0, 0, 0, 0, WSFONT_FIND_BITMAP); 219 if (cookie <= 0) 220 cookie = wsfont_find(NULL, 0, 0, 0, 0, 0, WSFONT_FIND_BITMAP); 221 if (cookie <= 0) { 222 printf("sfb: font table is empty\n"); 223 return; 224 } 225 226 if (wsfont_lock(cookie, &ri->ri_font)) { 227 printf("fb: can't lock font\n"); 228 return; 229 } 230 ri->ri_wsfcookie = cookie; 231 232 rasops_init(ri, 34, 80); 233 234 #if 0 235 /* XXX no accelarated functions yet */ 236 ri->ri_ops.putchar = xxx_putchar; 237 ri->ri_ops.erasecols = xxx_erasecols; 238 ri->ri_ops.copyrows = xxx_copyrows; 239 ri->ri_ops.eraserows = xxx_eraserows; 240 ir->ri_do_cursor = xxx_do_cursor; 241 #endif 242 243 /* XXX shouldn't be global */ 244 _fb_std_screen.nrows = ri->ri_rows; 245 _fb_std_screen.ncols = ri->ri_cols; 246 _fb_std_screen.textops = &ri->ri_ops; 247 _fb_std_screen.capabilities = ri->ri_caps; 248 } 249 250 int 251 fb_sbdio_cnattach(uint32_t mem, uint32_t reg, int flags) 252 { 253 struct rasops_info *ri; 254 struct ga *ga; 255 vaddr_t memva, regva; 256 long defattr; 257 258 ri = &fb_console_ri; 259 ga = &fb_console_ga; 260 261 ga->reg_paddr = reg; 262 ga->flags = flags; 263 fb_pmap_enter((paddr_t)mem, (paddr_t)reg, &memva, ®va); 264 ri->ri_bits = (void *)memva; 265 ga->reg_addr = regva; 266 267 fb_common_init(ri, ga); 268 269 (*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr); 270 wsdisplay_cnattach(&_fb_std_screen, ri, 0, 0, defattr); 271 fb_consaddr = mem; 272 273 return 0; 274 } 275 276 int 277 _fb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l) 278 { 279 struct fb_softc *sc = v; 280 struct wsdisplay_fbinfo *fbinfo = (void *)data; 281 struct wsdisplay_cmap *cmap = (void *)data; 282 struct rasops_info *ri = sc->sc_ri; 283 struct ga *ga = sc->sc_ga; 284 int i; 285 286 switch (cmd) { 287 case WSDISPLAYIO_GTYPE: 288 *(uint32_t *)data = WSDISPLAY_TYPE_UNKNOWN; 289 return 0; 290 291 case WSDISPLAYIO_GINFO: 292 fbinfo->height = ri->ri_height; 293 fbinfo->width = ri->ri_width; 294 fbinfo->depth = ri->ri_depth; 295 fbinfo->cmsize = 256; 296 return 0; 297 298 case WSDISPLAYIO_LINEBYTES: 299 *(u_int *)data = ri->ri_stride; 300 return 0; 301 302 case WSDISPLAYIO_GETCMAP: 303 if (ri->ri_flg == RI_FORCEMONO) 304 break; 305 ga_clut_get(ga); 306 for (i = 0; i < cmap->count; i++) { 307 cmap->red[i] = ga->clut[cmap->index + i][0]; 308 cmap->green[i] = ga->clut[cmap->index + i][1]; 309 cmap->blue[i] = ga->clut[cmap->index + i][2]; 310 } 311 return 0; 312 313 case WSDISPLAYIO_PUTCMAP: 314 if (ri->ri_flg == RI_FORCEMONO) 315 break; 316 for (i = 0; i < cmap->count; i++) { 317 ga->clut[cmap->index + i][0] = cmap->red[i]; 318 ga->clut[cmap->index + i][1] = cmap->green[i]; 319 ga->clut[cmap->index + i][2] = cmap->blue[i]; 320 } 321 ga_clut_set(ga); 322 return 0; 323 } 324 325 return EPASSTHROUGH; 326 } 327 328 paddr_t 329 _fb_mmap(void *v, void *vs, off_t offset, int prot) 330 { 331 332 if (offset < 0 || offset >= GA_FRB_SIZE) 333 return -1; 334 335 return mips_btop(GA_FRB_ADDR + offset); 336 } 337 338 int 339 _fb_alloc_screen(void *v, const struct wsscreen_descr *type, void **cookie, 340 int *curx, int *cury, long *attr) 341 { 342 struct fb_softc *sc = v; 343 struct rasops_info *ri = sc->sc_ri; 344 long defattr; 345 346 #if 0 347 if (sc->sc_nscreens > 0) 348 return ENOMEM; 349 #endif 350 351 *cookie = ri; 352 *curx = *cury = 0; 353 ri->ri_ops.allocattr(ri, 0, 0, 0, &defattr); 354 *attr = defattr; 355 sc->sc_nscreens++; 356 357 return 0; 358 } 359 360 void 361 _fb_free_screen(void *v, void *cookie) 362 { 363 struct fb_softc *sc = v; 364 365 sc->sc_nscreens--; 366 } 367 368 int 369 _fb_show_screen(void *v, void *cookie, int waitok, 370 void (*cb)(void *, int, int), void *cbarg) 371 { 372 373 return 0; 374 } 375 376 void 377 _fb_pollc(void *v, int on) 378 { 379 380 /* no interrupt used. */ 381 } 382 383 void 384 fb_pmap_enter(paddr_t fb_paddr, paddr_t reg_paddr, 385 vaddr_t *fb_vaddr, vaddr_t *reg_vaddr) 386 { 387 #ifdef WIRED_FB_TLB /* Make wired 16MPage for frame buffer */ 388 vaddr_t va; 389 vsize_t fb_off, reg_off, pgsize; 390 391 pgsize = MIPS3_WIRED_SIZE; 392 fb_off = fb_paddr & MIPS3_WIRED_OFFMASK; 393 reg_off = reg_paddr & MIPS3_WIRED_OFFMASK; 394 fb_paddr = fb_paddr & ~MIPS3_WIRED_OFFMASK; 395 reg_paddr = reg_paddr & ~MIPS3_WIRED_OFFMASK; 396 va = GA_FRB_ADDR; 397 398 if (mips3_wired_enter_page(va, fb_paddr, pgsize) == false) { 399 printf("cannot allocate fb memory\n"); 400 return; 401 } 402 403 if (mips3_wired_enter_page(va + pgsize, reg_paddr, pgsize) == false) { 404 printf("cannot allocate fb register\n"); 405 return; 406 } 407 408 *fb_vaddr = va + fb_off; 409 *reg_vaddr = va + pgsize + reg_off; 410 #else /* WIRED_FB_TLB */ 411 paddr_t pa, epa; 412 vaddr_t va, tva; 413 414 pa = addr; 415 epa = pa + size; 416 417 va = uvm_km_alloc(kernel_map, epa - pa, 0, UVM_KMF_VAONLY); 418 if (va == 0) 419 for (;;) 420 ROM_MONITOR(); 421 422 for (tva = va; pa < epa; pa += PAGE_SIZE, tva += PAGE_SIZE) 423 pmap_kenter_pa(tva, pa, VM_PROT_READ | VM_PROT_WRITE, 0); 424 425 pmap_update(pmap_kernel()); 426 427 *fb_vaddr = va; 428 #endif /* WIRED_FB_TLB */ 429 } 430
Indexes created Thu Oct 02 14:10:14 GMT 2025