1 /*-
2 * SPDX-License-Identifier: BSD-3-Clause
3 *
4 * Copyright (c) 1999 Kazutaka YOKOTA <yokota@zodiac.mech.utsunomiya-u.ac.jp>
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer as
12 * the first lines of this file unmodified.
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. The name of the author may not be used to endorse or promote products
17 * derived from this software without specific prior written permission.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
20 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
21 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
22 * IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY DIRECT, INDIRECT,
23 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
24 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
25 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
26 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
27 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
28 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
29 */
30
31 #include <sys/cdefs.h>
32 #include "opt_fb.h"
33
34 #include <sys/param.h>
35 #include <sys/systm.h>
36 #include <sys/conf.h>
37 #include <sys/bus.h>
38 #include <sys/kernel.h>
39 #include <sys/malloc.h>
40 #include <sys/module.h>
41 #include <sys/uio.h>
42 #include <sys/fbio.h>
43 #include <sys/linker_set.h>
44
45 #include <vm/vm.h>
46 #include <vm/pmap.h>
47
48 #include <dev/fb/fbreg.h>
49
50 SET_DECLARE(videodriver_set, const video_driver_t);
51
52 /* local arrays */
53
54 /*
55 * We need at least one entry each in order to initialize a video card
56 * for the kernel console. The arrays will be increased dynamically
57 * when necessary.
58 */
59
60 static int vid_malloc;
61 static int adapters = 1;
62 static video_adapter_t *adp_ini;
63 static video_adapter_t **adapter = &adp_ini;
64 static video_switch_t *vidsw_ini;
65 video_switch_t **vidsw = &vidsw_ini;
66
67 #define ARRAY_DELTA 4
68
69 static int
vid_realloc_array(void)70 vid_realloc_array(void)
71 {
72 video_adapter_t **new_adp;
73 video_switch_t **new_vidsw;
74 int newsize;
75 int s;
76
77 if (!vid_malloc)
78 return ENOMEM;
79
80 s = spltty();
81 newsize = rounddown(adapters + ARRAY_DELTA, ARRAY_DELTA);
82 new_adp = malloc(sizeof(*new_adp)*newsize, M_DEVBUF, M_WAITOK | M_ZERO);
83 new_vidsw = malloc(sizeof(*new_vidsw)*newsize, M_DEVBUF,
84 M_WAITOK | M_ZERO);
85 bcopy(adapter, new_adp, sizeof(*adapter)*adapters);
86 bcopy(vidsw, new_vidsw, sizeof(*vidsw)*adapters);
87 if (adapters > 1) {
88 free(adapter, M_DEVBUF);
89 free(vidsw, M_DEVBUF);
90 }
91 adapter = new_adp;
92 vidsw = new_vidsw;
93 adapters = newsize;
94 splx(s);
95
96 if (bootverbose)
97 printf("fb: new array size %d\n", adapters);
98
99 return 0;
100 }
101
102 static void
vid_malloc_init(void * arg)103 vid_malloc_init(void *arg)
104 {
105 vid_malloc = TRUE;
106 }
107
108 SYSINIT(vid_mem, SI_SUB_KMEM, SI_ORDER_ANY, vid_malloc_init, NULL);
109
110 /*
111 * Low-level frame buffer driver functions
112 * frame buffer subdrivers, such as the VGA driver, call these functions
113 * to initialize the video_adapter structure and register it to the virtual
114 * frame buffer driver `fb'.
115 */
116
117 /* initialize the video_adapter_t structure */
118 void
vid_init_struct(video_adapter_t * adp,char * name,int type,int unit)119 vid_init_struct(video_adapter_t *adp, char *name, int type, int unit)
120 {
121 adp->va_flags = 0;
122 adp->va_name = name;
123 adp->va_type = type;
124 adp->va_unit = unit;
125 }
126
127 /* Register a video adapter */
128 int
vid_register(video_adapter_t * adp)129 vid_register(video_adapter_t *adp)
130 {
131 const video_driver_t **list;
132 const video_driver_t *p;
133 int index;
134
135 for (index = 0; index < adapters; ++index) {
136 if (adapter[index] == NULL)
137 break;
138 }
139 if (index >= adapters) {
140 if (vid_realloc_array())
141 return -1;
142 }
143
144 adp->va_index = index;
145 adp->va_token = NULL;
146 SET_FOREACH(list, videodriver_set) {
147 p = *list;
148 if (strcmp(p->name, adp->va_name) == 0) {
149 adapter[index] = adp;
150 vidsw[index] = p->vidsw;
151 return index;
152 }
153 }
154
155 return -1;
156 }
157
158 int
vid_unregister(video_adapter_t * adp)159 vid_unregister(video_adapter_t *adp)
160 {
161 if ((adp->va_index < 0) || (adp->va_index >= adapters))
162 return ENOENT;
163 if (adapter[adp->va_index] != adp)
164 return ENOENT;
165
166 adapter[adp->va_index] = NULL;
167 vidsw[adp->va_index] = NULL;
168 return 0;
169 }
170
171 /* Get video I/O function table */
172 video_switch_t
vid_get_switch(char * name)173 *vid_get_switch(char *name)
174 {
175 const video_driver_t **list;
176 const video_driver_t *p;
177
178 SET_FOREACH(list, videodriver_set) {
179 p = *list;
180 if (strcmp(p->name, name) == 0)
181 return p->vidsw;
182 }
183
184 return NULL;
185 }
186
187 /*
188 * Video card client functions
189 * Video card clients, such as the console driver `syscons' and the frame
190 * buffer cdev driver, use these functions to claim and release a card for
191 * exclusive use.
192 */
193
194 /* find the video card specified by a driver name and a unit number */
195 int
vid_find_adapter(char * driver,int unit)196 vid_find_adapter(char *driver, int unit)
197 {
198 int i;
199
200 for (i = 0; i < adapters; ++i) {
201 if (adapter[i] == NULL)
202 continue;
203 if (strcmp("*", driver) && strcmp(adapter[i]->va_name, driver))
204 continue;
205 if ((unit != -1) && (adapter[i]->va_unit != unit))
206 continue;
207 return i;
208 }
209 return -1;
210 }
211
212 /* allocate a video card */
213 int
vid_allocate(char * driver,int unit,void * id)214 vid_allocate(char *driver, int unit, void *id)
215 {
216 int index;
217 int s;
218
219 s = spltty();
220 index = vid_find_adapter(driver, unit);
221 if (index >= 0) {
222 if (adapter[index]->va_token) {
223 splx(s);
224 return -1;
225 }
226 adapter[index]->va_token = id;
227 }
228 splx(s);
229 return index;
230 }
231
232 int
vid_release(video_adapter_t * adp,void * id)233 vid_release(video_adapter_t *adp, void *id)
234 {
235 int error;
236 int s;
237
238 s = spltty();
239 if (adp->va_token == NULL) {
240 error = EINVAL;
241 } else if (adp->va_token != id) {
242 error = EPERM;
243 } else {
244 adp->va_token = NULL;
245 error = 0;
246 }
247 splx(s);
248 return error;
249 }
250
251 /* Get a video adapter structure */
252 video_adapter_t
vid_get_adapter(int index)253 *vid_get_adapter(int index)
254 {
255 if ((index < 0) || (index >= adapters))
256 return NULL;
257 return adapter[index];
258 }
259
260 /* Configure drivers: this is a backdoor for the console driver XXX */
261 int
vid_configure(int flags)262 vid_configure(int flags)
263 {
264 const video_driver_t **list;
265 const video_driver_t *p;
266
267 SET_FOREACH(list, videodriver_set) {
268 p = *list;
269 if (p->configure != NULL)
270 (*p->configure)(flags);
271 }
272
273 return 0;
274 }
275
276 #define FB_DRIVER_NAME "fb"
277
278 static char
adapter_name(int type)279 *adapter_name(int type)
280 {
281 static struct {
282 int type;
283 char *name;
284 } names[] = {
285 { KD_MONO, "MDA" },
286 { KD_HERCULES, "Hercules" },
287 { KD_CGA, "CGA" },
288 { KD_EGA, "EGA" },
289 { KD_VGA, "VGA" },
290 { KD_TGA, "TGA" },
291 { -1, "Unknown" },
292 };
293 int i;
294
295 for (i = 0; names[i].type != -1; ++i)
296 if (names[i].type == type)
297 break;
298 return names[i].name;
299 }
300
301 /*
302 * Generic low-level frame buffer functions
303 * The low-level functions in the frame buffer subdriver may use these
304 * functions.
305 */
306
307 void
fb_dump_adp_info(char * driver,video_adapter_t * adp,int level)308 fb_dump_adp_info(char *driver, video_adapter_t *adp, int level)
309 {
310 if (level <= 0)
311 return;
312
313 printf("%s%d: %s%d, %s, type:%s (%d), flags:0x%x\n",
314 FB_DRIVER_NAME, adp->va_index, driver, adp->va_unit, adp->va_name,
315 adapter_name(adp->va_type), adp->va_type, adp->va_flags);
316 printf("%s%d: port:0x%lx-0x%lx, crtc:0x%lx, mem:0x%lx 0x%x\n",
317 FB_DRIVER_NAME, adp->va_index, (u_long)adp->va_io_base,
318 (u_long)adp->va_io_base + adp->va_io_size - 1,
319 (u_long)adp->va_crtc_addr, (u_long)adp->va_mem_base,
320 adp->va_mem_size);
321 printf("%s%d: init mode:%d, bios mode:%d, current mode:%d\n",
322 FB_DRIVER_NAME, adp->va_index,
323 adp->va_initial_mode, adp->va_initial_bios_mode, adp->va_mode);
324 printf("%s%d: window:%p size:%dk gran:%dk, buf:%p size:%dk\n",
325 FB_DRIVER_NAME, adp->va_index,
326 (void *)adp->va_window, (int)adp->va_window_size/1024,
327 (int)adp->va_window_gran/1024, (void *)adp->va_buffer,
328 (int)adp->va_buffer_size/1024);
329 }
330
331 void
fb_dump_mode_info(char * driver,video_adapter_t * adp,video_info_t * info,int level)332 fb_dump_mode_info(char *driver, video_adapter_t *adp, video_info_t *info,
333 int level)
334 {
335 if (level <= 0)
336 return;
337
338 printf("%s%d: %s, mode:%d, flags:0x%x ",
339 driver, adp->va_unit, adp->va_name, info->vi_mode, info->vi_flags);
340 if (info->vi_flags & V_INFO_GRAPHICS)
341 printf("G %dx%dx%d, %d plane(s), font:%dx%d, ",
342 info->vi_width, info->vi_height,
343 info->vi_depth, info->vi_planes,
344 info->vi_cwidth, info->vi_cheight);
345 else
346 printf("T %dx%d, font:%dx%d, ",
347 info->vi_width, info->vi_height,
348 info->vi_cwidth, info->vi_cheight);
349 printf("win:0x%lx\n", (u_long)info->vi_window);
350 }
351
352 int
fb_type(int adp_type)353 fb_type(int adp_type)
354 {
355 static struct {
356 int fb_type;
357 int va_type;
358 } types[] = {
359 { FBTYPE_MDA, KD_MONO },
360 { FBTYPE_HERCULES, KD_HERCULES },
361 { FBTYPE_CGA, KD_CGA },
362 { FBTYPE_EGA, KD_EGA },
363 { FBTYPE_VGA, KD_VGA },
364 { FBTYPE_TGA, KD_TGA },
365 };
366 int i;
367
368 for (i = 0; i < nitems(types); ++i) {
369 if (types[i].va_type == adp_type)
370 return types[i].fb_type;
371 }
372 return -1;
373 }
374
375 int
fb_commonioctl(video_adapter_t * adp,u_long cmd,caddr_t arg)376 fb_commonioctl(video_adapter_t *adp, u_long cmd, caddr_t arg)
377 {
378 int error;
379 int s;
380
381 /* assert(adp != NULL) */
382
383 error = 0;
384 s = spltty();
385
386 switch (cmd) {
387
388 case FBIO_ADAPTER: /* get video adapter index */
389 *(int *)arg = adp->va_index;
390 break;
391
392 case FBIO_ADPTYPE: /* get video adapter type */
393 *(int *)arg = adp->va_type;
394 break;
395
396 case FBIO_ADPINFO: /* get video adapter info */
397 ((video_adapter_info_t *)arg)->va_index = adp->va_index;
398 ((video_adapter_info_t *)arg)->va_type = adp->va_type;
399 bcopy(adp->va_name, ((video_adapter_info_t *)arg)->va_name,
400 imin(strlen(adp->va_name) + 1,
401 sizeof(((video_adapter_info_t *)arg)->va_name)));
402 ((video_adapter_info_t *)arg)->va_unit = adp->va_unit;
403 ((video_adapter_info_t *)arg)->va_flags = adp->va_flags;
404 ((video_adapter_info_t *)arg)->va_io_base = adp->va_io_base;
405 ((video_adapter_info_t *)arg)->va_io_size = adp->va_io_size;
406 ((video_adapter_info_t *)arg)->va_crtc_addr = adp->va_crtc_addr;
407 ((video_adapter_info_t *)arg)->va_mem_base = adp->va_mem_base;
408 ((video_adapter_info_t *)arg)->va_mem_size = adp->va_mem_size;
409 ((video_adapter_info_t *)arg)->va_window
410 #if defined(__amd64__) || defined(__i386__)
411 = vtophys(adp->va_window);
412 #else
413 = adp->va_window;
414 #endif
415 ((video_adapter_info_t *)arg)->va_window_size
416 = adp->va_window_size;
417 ((video_adapter_info_t *)arg)->va_window_gran
418 = adp->va_window_gran;
419 ((video_adapter_info_t *)arg)->va_window_orig
420 = adp->va_window_orig;
421 ((video_adapter_info_t *)arg)->va_unused0
422 #if defined(__amd64__) || defined(__i386__)
423 = adp->va_buffer != 0 ? vtophys(adp->va_buffer) : 0;
424 #else
425 = adp->va_buffer;
426 #endif
427 ((video_adapter_info_t *)arg)->va_buffer_size
428 = adp->va_buffer_size;
429 ((video_adapter_info_t *)arg)->va_mode = adp->va_mode;
430 ((video_adapter_info_t *)arg)->va_initial_mode
431 = adp->va_initial_mode;
432 ((video_adapter_info_t *)arg)->va_initial_bios_mode
433 = adp->va_initial_bios_mode;
434 ((video_adapter_info_t *)arg)->va_line_width
435 = adp->va_line_width;
436 ((video_adapter_info_t *)arg)->va_disp_start.x
437 = adp->va_disp_start.x;
438 ((video_adapter_info_t *)arg)->va_disp_start.y
439 = adp->va_disp_start.y;
440 break;
441
442 case FBIO_MODEINFO: /* get mode information */
443 error = vidd_get_info(adp,
444 ((video_info_t *)arg)->vi_mode,
445 (video_info_t *)arg);
446 if (error)
447 error = ENODEV;
448 break;
449
450 case FBIO_FINDMODE: /* find a matching video mode */
451 error = vidd_query_mode(adp, (video_info_t *)arg);
452 break;
453
454 case FBIO_GETMODE: /* get video mode */
455 *(int *)arg = adp->va_mode;
456 break;
457
458 case FBIO_SETMODE: /* set video mode */
459 error = vidd_set_mode(adp, *(int *)arg);
460 if (error)
461 error = ENODEV; /* EINVAL? */
462 break;
463
464 case FBIO_GETWINORG: /* get frame buffer window origin */
465 *(u_int *)arg = adp->va_window_orig;
466 break;
467
468 case FBIO_GETDISPSTART: /* get display start address */
469 ((video_display_start_t *)arg)->x = adp->va_disp_start.x;
470 ((video_display_start_t *)arg)->y = adp->va_disp_start.y;
471 break;
472
473 case FBIO_GETLINEWIDTH: /* get scan line width in bytes */
474 *(u_int *)arg = adp->va_line_width;
475 break;
476
477 case FBIO_BLANK: /* blank display */
478 error = vidd_blank_display(adp, *(int *)arg);
479 break;
480
481 case FBIO_GETPALETTE: /* get color palette */
482 case FBIO_SETPALETTE: /* set color palette */
483 /* XXX */
484
485 case FBIOPUTCMAP:
486 case FBIOGETCMAP:
487 /* XXX */
488
489 case FBIO_SETWINORG: /* set frame buffer window origin */
490 case FBIO_SETDISPSTART: /* set display start address */
491 case FBIO_SETLINEWIDTH: /* set scan line width in pixel */
492
493 case FBIOGTYPE:
494
495 default:
496 error = ENODEV;
497 break;
498 }
499
500 splx(s);
501 return error;
502 }
503