1 /* $NetBSD: fb_sbdio.c,v 1.20 2021/08/07 16:18:53 thorpej 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.20 2021/08/07 16:18:53 thorpej Exp $");
36
37 #include <sys/param.h>
38 #include <sys/systm.h>
39 #include <sys/kmem.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/locore.h>
50 #include <mips/pte.h>
51
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
fb_sbdio_match(device_t parent,cfdata_t cf,void * aux)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
fb_sbdio_attach(device_t parent,device_t self,void * aux)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 = kmem_zalloc(sizeof(struct rasops_info), KM_SLEEP);
149 ga = kmem_zalloc(sizeof(struct ga), KM_SLEEP);
150 ga->reg_paddr = sa->sa_addr2;
151 ga->flags = sa->sa_flags;
152 fb_pmap_enter(sa->sa_addr1, sa->sa_addr2,
153 &memva, ®va);
154 ri->ri_bits = (void *)memva;
155 ga->reg_addr = regva;
156 fb_common_init(ri, ga);
157 sc->sc_ri = ri;
158 sc->sc_ga = ga;
159 }
160
161 wa.console = console;
162 wa.scrdata = &_fb_screen_list;
163 wa.accessops = &_fb_accessops;
164 wa.accesscookie = (void *)sc;
165
166 config_found(self, &wa, wsdisplaydevprint, CFARGS_NONE);
167 }
168
169 void
fb_common_init(struct rasops_info * ri,struct ga * ga)170 fb_common_init(struct rasops_info *ri, struct ga *ga)
171 {
172 int ga_active, cookie;
173
174 /* XXX */
175 ga_active = 0;
176 if (ga->flags == 0x0000 || ga->flags == 0x0001)
177 ga_active = ga_init(ga);
178
179 /*
180 * TR2 IPL CLUT.
181 * 0 black
182 * 1 red
183 * 2 green
184 * 4 blue
185 * 8 yellow
186 * 16 cyan
187 * 32 magenta
188 * 64 light gray
189 * 128 dark gray
190 * 255 white
191 * other black
192 * When CLUT isn't initialized for NetBSD, use black-red pair.
193 */
194 ri->ri_flg = RI_CENTER | RI_CLEAR;
195 if (!ga_active)
196 ri->ri_flg |= RI_FORCEMONO;
197 if (ri == &fb_console_ri)
198 ri->ri_flg |= RI_NO_AUTO;
199
200 ri->ri_depth = 8;
201 ri->ri_width = 1280;
202 ri->ri_height = 1024;
203 ri->ri_stride = 2048;
204 ri->ri_hw = (void *)ga;
205
206 wsfont_init();
207 /* prefer 12 pixel wide font */
208 cookie = wsfont_find(NULL, 12, 0, 0, 0, 0, WSFONT_FIND_BITMAP);
209 if (cookie <= 0)
210 cookie = wsfont_find(NULL, 0, 0, 0, 0, 0, WSFONT_FIND_BITMAP);
211 if (cookie <= 0) {
212 printf("sfb: font table is empty\n");
213 return;
214 }
215
216 if (wsfont_lock(cookie, &ri->ri_font)) {
217 printf("fb: can't lock font\n");
218 return;
219 }
220 ri->ri_wsfcookie = cookie;
221
222 rasops_init(ri, 34, 80);
223
224 #if 0
225 /* XXX no accelarated functions yet */
226 ri->ri_ops.putchar = xxx_putchar;
227 ri->ri_ops.erasecols = xxx_erasecols;
228 ri->ri_ops.copyrows = xxx_copyrows;
229 ri->ri_ops.eraserows = xxx_eraserows;
230 ir->ri_do_cursor = xxx_do_cursor;
231 #endif
232
233 /* XXX shouldn't be global */
234 _fb_std_screen.nrows = ri->ri_rows;
235 _fb_std_screen.ncols = ri->ri_cols;
236 _fb_std_screen.textops = &ri->ri_ops;
237 _fb_std_screen.capabilities = ri->ri_caps;
238 }
239
240 int
fb_sbdio_cnattach(uint32_t mem,uint32_t reg,int flags)241 fb_sbdio_cnattach(uint32_t mem, uint32_t reg, int flags)
242 {
243 struct rasops_info *ri;
244 struct ga *ga;
245 vaddr_t memva, regva;
246 long defattr;
247
248 ri = &fb_console_ri;
249 ga = &fb_console_ga;
250
251 ga->reg_paddr = reg;
252 ga->flags = flags;
253 fb_pmap_enter((paddr_t)mem, (paddr_t)reg, &memva, ®va);
254 ri->ri_bits = (void *)memva;
255 ga->reg_addr = regva;
256
257 fb_common_init(ri, ga);
258
259 (*ri->ri_ops.allocattr)(ri, 0, 0, 0, &defattr);
260 wsdisplay_cnattach(&_fb_std_screen, ri, 0, 0, defattr);
261 fb_consaddr = mem;
262
263 return 0;
264 }
265
266 int
_fb_ioctl(void * v,void * vs,u_long cmd,void * data,int flag,struct lwp * l)267 _fb_ioctl(void *v, void *vs, u_long cmd, void *data, int flag, struct lwp *l)
268 {
269 struct fb_softc *sc = v;
270 struct wsdisplay_fbinfo *fbinfo = (void *)data;
271 struct wsdisplay_cmap *cmap = (void *)data;
272 struct rasops_info *ri = sc->sc_ri;
273 struct ga *ga = sc->sc_ga;
274 int i;
275
276 switch (cmd) {
277 case WSDISPLAYIO_GTYPE:
278 *(uint32_t *)data = WSDISPLAY_TYPE_UNKNOWN;
279 return 0;
280
281 case WSDISPLAYIO_GINFO:
282 fbinfo->height = ri->ri_height;
283 fbinfo->width = ri->ri_width;
284 fbinfo->depth = ri->ri_depth;
285 fbinfo->cmsize = 256;
286 return 0;
287
288 case WSDISPLAYIO_LINEBYTES:
289 *(u_int *)data = ri->ri_stride;
290 return 0;
291
292 case WSDISPLAYIO_GETCMAP:
293 if (ri->ri_flg == RI_FORCEMONO)
294 break;
295 ga_clut_get(ga);
296 if (cmap->index >= 256 || cmap->count > 256 - cmap->index)
297 return (EINVAL);
298 for (i = 0; i < cmap->count; i++) {
299 cmap->red[i] = ga->clut[cmap->index + i][0];
300 cmap->green[i] = ga->clut[cmap->index + i][1];
301 cmap->blue[i] = ga->clut[cmap->index + i][2];
302 }
303 return 0;
304
305 case WSDISPLAYIO_PUTCMAP:
306 if (ri->ri_flg == RI_FORCEMONO)
307 break;
308 if (cmap->index >= 256 || cmap->count > 256 - cmap->index)
309 return (EINVAL);
310 for (i = 0; i < cmap->count; i++) {
311 ga->clut[cmap->index + i][0] = cmap->red[i];
312 ga->clut[cmap->index + i][1] = cmap->green[i];
313 ga->clut[cmap->index + i][2] = cmap->blue[i];
314 }
315 ga_clut_set(ga);
316 return 0;
317 }
318
319 return EPASSTHROUGH;
320 }
321
322 paddr_t
_fb_mmap(void * v,void * vs,off_t offset,int prot)323 _fb_mmap(void *v, void *vs, off_t offset, int prot)
324 {
325
326 if (offset < 0 || offset >= GA_FRB_SIZE)
327 return -1;
328
329 return mips_btop(GA_FRB_ADDR + offset);
330 }
331
332 int
_fb_alloc_screen(void * v,const struct wsscreen_descr * type,void ** cookie,int * curx,int * cury,long * attr)333 _fb_alloc_screen(void *v, const struct wsscreen_descr *type, void **cookie,
334 int *curx, int *cury, long *attr)
335 {
336 struct fb_softc *sc = v;
337 struct rasops_info *ri = sc->sc_ri;
338 long defattr;
339
340 #if 0
341 if (sc->sc_nscreens > 0)
342 return ENOMEM;
343 #endif
344
345 *cookie = ri;
346 *curx = *cury = 0;
347 ri->ri_ops.allocattr(ri, 0, 0, 0, &defattr);
348 *attr = defattr;
349 sc->sc_nscreens++;
350
351 return 0;
352 }
353
354 void
_fb_free_screen(void * v,void * cookie)355 _fb_free_screen(void *v, void *cookie)
356 {
357 struct fb_softc *sc = v;
358
359 sc->sc_nscreens--;
360 }
361
362 int
_fb_show_screen(void * v,void * cookie,int waitok,void (* cb)(void *,int,int),void * cbarg)363 _fb_show_screen(void *v, void *cookie, int waitok,
364 void (*cb)(void *, int, int), void *cbarg)
365 {
366
367 return 0;
368 }
369
370 void
_fb_pollc(void * v,int on)371 _fb_pollc(void *v, int on)
372 {
373
374 /* no interrupt used. */
375 }
376
377 void
fb_pmap_enter(paddr_t fb_paddr,paddr_t reg_paddr,vaddr_t * fb_vaddr,vaddr_t * reg_vaddr)378 fb_pmap_enter(paddr_t fb_paddr, paddr_t reg_paddr,
379 vaddr_t *fb_vaddr, vaddr_t *reg_vaddr)
380 {
381 #ifdef WIRED_FB_TLB /* Make wired 16MPage for frame buffer */
382 vaddr_t va;
383 vsize_t fb_off, reg_off, pgsize;
384
385 pgsize = MIPS3_WIRED_SIZE;
386 fb_off = fb_paddr & MIPS3_WIRED_OFFMASK;
387 reg_off = reg_paddr & MIPS3_WIRED_OFFMASK;
388 fb_paddr = fb_paddr & ~MIPS3_WIRED_OFFMASK;
389 reg_paddr = reg_paddr & ~MIPS3_WIRED_OFFMASK;
390 va = GA_FRB_ADDR;
391
392 if (mips3_wired_enter_page(va, fb_paddr, pgsize) == false) {
393 printf("cannot allocate fb memory\n");
394 return;
395 }
396
397 if (mips3_wired_enter_page(va + pgsize, reg_paddr, pgsize) == false) {
398 printf("cannot allocate fb register\n");
399 return;
400 }
401
402 *fb_vaddr = va + fb_off;
403 *reg_vaddr = va + pgsize + reg_off;
404 #else /* WIRED_FB_TLB */
405 paddr_t pa, epa;
406 vaddr_t va, tva;
407
408 pa = addr;
409 epa = pa + size;
410
411 va = uvm_km_alloc(kernel_map, epa - pa, 0, UVM_KMF_VAONLY);
412 if (va == 0)
413 for (;;)
414 ROM_MONITOR();
415
416 for (tva = va; pa < epa; pa += PAGE_SIZE, tva += PAGE_SIZE)
417 pmap_kenter_pa(tva, pa, VM_PROT_READ | VM_PROT_WRITE, 0);
418
419 pmap_update(pmap_kernel());
420
421 *fb_vaddr = va;
422 #endif /* WIRED_FB_TLB */
423 }
424