xref: /freebsd/sys/dev/vt/hw/efifb/efifb.c (revision 76b28ad6ab6dc8d4a62cb7de7f143595be535813)
1 /*-
2  * Copyright (c) 2014 The FreeBSD Foundation
3  * All rights reserved.
4  *
5  * This software was developed by Aleksandr Rybalko under sponsorship from the
6  * FreeBSD Foundation.
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  *
17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27  * SUCH DAMAGE.
28  *
29  * $FreeBSD$
30  */
31 
32 #include <sys/cdefs.h>
33 __FBSDID("$FreeBSD$");
34 
35 #include <sys/param.h>
36 #include <sys/systm.h>
37 #include <sys/kernel.h>
38 #include <sys/fbio.h>
39 #include <sys/linker.h>
40 
41 #include "opt_platform.h"
42 
43 #include <machine/metadata.h>
44 #include <machine/vm.h>
45 #include <machine/vmparam.h>
46 #include <vm/vm.h>
47 #include <vm/pmap.h>
48 #include <machine/pmap.h>
49 
50 #include <dev/vt/vt.h>
51 #include <dev/vt/hw/fb/vt_fb.h>
52 #include <dev/vt/colors/vt_termcolors.h>
53 
54 static vd_init_t vt_efifb_init;
55 static vd_probe_t vt_efifb_probe;
56 
57 static struct vt_driver vt_efifb_driver = {
58 	.vd_name = "efifb",
59 	.vd_probe = vt_efifb_probe,
60 	.vd_init = vt_efifb_init,
61 	.vd_blank = vt_fb_blank,
62 	.vd_bitbltchr = vt_fb_bitbltchr,
63 	.vd_maskbitbltchr = vt_fb_maskbitbltchr,
64 	/* Better than VGA, but still generic driver. */
65 	.vd_priority = VD_PRIORITY_GENERIC + 1,
66 };
67 
68 static struct fb_info local_info;
69 VT_DRIVER_DECLARE(vt_efifb, vt_efifb_driver);
70 
71 static int
72 vt_efifb_probe(struct vt_device *vd)
73 {
74 	int		disabled;
75 	struct efi_fb	*efifb;
76 	caddr_t		kmdp;
77 
78 	disabled = 0;
79 	TUNABLE_INT_FETCH("hw.syscons.disable", &disabled);
80 	if (disabled != 0)
81 		return (CN_DEAD);
82 
83 	kmdp = preload_search_by_type("elf kernel");
84 	if (kmdp == NULL)
85 		kmdp = preload_search_by_type("elf64 kernel");
86 	efifb = (struct efi_fb *)preload_search_info(kmdp,
87 	    MODINFO_METADATA | MODINFOMD_EFI_FB);
88 	if (efifb == NULL)
89 		return (CN_DEAD);
90 
91 	return (CN_INTERNAL);
92 }
93 
94 static int
95 vt_efifb_init(struct vt_device *vd)
96 {
97 	int		depth, d, i, len;
98 	struct fb_info	*info;
99 	struct efi_fb	*efifb;
100 	caddr_t		kmdp;
101 
102 	info = vd->vd_softc;
103 	if (info == NULL)
104 		info = vd->vd_softc = (void *)&local_info;
105 
106 	kmdp = preload_search_by_type("elf kernel");
107 	if (kmdp == NULL)
108 		kmdp = preload_search_by_type("elf64 kernel");
109 	efifb = (struct efi_fb *)preload_search_info(kmdp,
110 	    MODINFO_METADATA | MODINFOMD_EFI_FB);
111 	if (efifb == NULL)
112 		return (CN_DEAD);
113 
114 	info->fb_height = efifb->fb_height;
115 	info->fb_width = efifb->fb_width;
116 
117 	depth = fls(efifb->fb_mask_red);
118 	d = fls(efifb->fb_mask_green);
119 	depth = d > depth ? d : depth;
120 	d = fls(efifb->fb_mask_blue);
121 	depth = d > depth ? d : depth;
122 	d = fls(efifb->fb_mask_reserved);
123 	depth = d > depth ? d : depth;
124 	info->fb_depth = depth;
125 
126 	info->fb_stride = efifb->fb_stride * (depth / 8);
127 
128 	vt_generate_vga_palette(info->fb_cmap, COLOR_FORMAT_RGB,
129 	    efifb->fb_mask_red, ffs(efifb->fb_mask_red) - 1,
130 	    efifb->fb_mask_green, ffs(efifb->fb_mask_green) - 1,
131 	    efifb->fb_mask_blue, ffs(efifb->fb_mask_blue) - 1);
132 
133 	info->fb_size = info->fb_height * info->fb_stride;
134 	info->fb_pbase = efifb->fb_addr;
135 	/*
136 	 * We could use pmap_mapdev here except that the kernel pmap
137 	 * hasn't been created yet and hence any attempt to lock it will
138 	 * fail.
139 	 */
140 	info->fb_vbase = PHYS_TO_DMAP(efifb->fb_addr);
141 
142 	/* blank full size */
143 	len = info->fb_size / 4;
144 	for (i = 0; i < len; i++) {
145 		((uint32_t *)info->fb_vbase)[i] = 0;
146 	}
147 
148 	/* Get pixel storage size. */
149 	info->fb_bpp = info->fb_stride / info->fb_width * 8;
150 
151 	/*
152 	 * Early FB driver work with static window buffer, so reduce to minimal
153 	 * size, buffer or screen.
154 	 */
155 	info->fb_width = MIN(info->fb_width, VT_FB_DEFAULT_WIDTH);
156 	info->fb_height = MIN(info->fb_height, VT_FB_DEFAULT_HEIGHT);
157 
158 	fb_probe(info);
159 	vt_fb_init(vd);
160 
161 	/* Clear the screen. */
162 	vt_fb_blank(vd, TC_BLACK);
163 
164 	return (CN_INTERNAL);
165 }
166