1 /* SPDX-License-Identifier: MIT */
2 /*
3 * Copied from Linux drivers/gpu/drm/ast/ast_mode.c
4 */
5
6 #include <console/console.h>
7 #include <edid.h>
8 #include <device/pci_def.h>
9 #include <framebuffer_info.h>
10
11 #include "ast_drv.h"
12
13 /*
14 * Set framebuffer MMIO address, which must fall into BAR0 MMIO window.
15 *
16 * Complete reimplementation as the original expects multiple kernel internal
17 * subsystems to be present.
18 */
ast_crtc_do_set_base(struct drm_crtc * crtc)19 int ast_crtc_do_set_base(struct drm_crtc *crtc)
20 {
21 struct ast_private *ast = crtc->dev->dev_private;
22 struct drm_framebuffer *fb = crtc->primary->fb;
23
24 /* PCI BAR 0 */
25 struct resource *res = probe_resource(crtc->dev->pdev, PCI_BASE_ADDRESS_0);
26 if (!res) {
27 printk(BIOS_ERR, "BAR0 resource not found.\n");
28 return -EIO;
29 }
30
31 if (res->size < fb->pitches[0] * crtc->mode.vdisplay) {
32 dev_err(dev->pdev, "Framebuffer doesn't fit into BAR0 MMIO window\n");
33 return -ENOMEM;
34 }
35
36 fb->mmio_addr = (uintptr_t)res2mmio(res, 4095, 4095);
37
38 ast_set_offset_reg(crtc);
39 ast_set_start_address_crt1(ast, fb->mmio_addr);
40
41 return 0;
42 }
43
ast_edid_to_drmmode(struct edid * edid,struct drm_display_mode * mode)44 static void ast_edid_to_drmmode(struct edid *edid, struct drm_display_mode *mode)
45 {
46 memset(mode, 0, sizeof(*mode));
47
48 mode->hdisplay = edid->mode.ha;
49 mode->vdisplay = edid->mode.va;
50 mode->crtc_hdisplay = edid->mode.ha;
51 mode->crtc_vdisplay = edid->mode.va;
52
53 /* EDID clock is in 10kHz, but drm clock is in KHz */
54 mode->clock = edid->mode.pixel_clock * 10;
55 mode->vrefresh = edid->mode.refresh;
56
57 mode->crtc_hblank_start = edid->mode.ha;
58 mode->crtc_hblank_end = edid->mode.ha + edid->mode.hbl;
59 mode->crtc_hsync_start = edid->mode.ha + edid->mode.hso;
60 mode->crtc_hsync_end = edid->mode.ha + edid->mode.hso + edid->mode.hspw;
61 mode->crtc_htotal = mode->crtc_hblank_end;
62
63 mode->crtc_vblank_start = edid->mode.va;
64 mode->crtc_vblank_end = edid->mode.va + edid->mode.vbl;
65 mode->crtc_vsync_start = edid->mode.va + edid->mode.vso;
66 mode->crtc_vsync_end = edid->mode.va + edid->mode.vso + edid->mode.vspw;
67 mode->crtc_vtotal = mode->crtc_vblank_end;
68
69 mode->flags = 0;
70 if (edid->mode.phsync == '+')
71 mode->flags |= DRM_MODE_FLAG_PHSYNC;
72 else
73 mode->flags |= DRM_MODE_FLAG_NHSYNC;
74
75 if (edid->mode.pvsync == '+')
76 mode->flags |= DRM_MODE_FLAG_PVSYNC;
77 else
78 mode->flags |= DRM_MODE_FLAG_NVSYNC;
79 }
80
ast_select_mode(struct drm_connector * connector,struct edid * edid)81 static int ast_select_mode(struct drm_connector *connector,
82 struct edid *edid)
83 {
84 struct ast_private *ast = connector->dev->dev_private;
85 bool widescreen;
86 u8 raw[128];
87 bool flags = false;
88
89 if (ast->tx_chip_type == AST_TX_DP501) {
90 ast->dp501_maxclk = 0xff;
91 flags = ast_dp501_read_edid(connector->dev, (u8 *)raw);
92 if (flags)
93 ast->dp501_maxclk = ast_get_dp501_max_clk(connector->dev);
94 else
95 dev_err(dev->pdev, "I2C transmission error\n");
96 }
97
98 if (!flags)
99 ast_software_i2c_read(ast, raw);
100
101 if (decode_edid(raw, sizeof(raw), edid) != EDID_CONFORMANT) {
102 /*
103 * Servers often run headless, so a missing EDID is not an error.
104 * We still need to initialize a framebuffer for KVM, though.
105 */
106 dev_info(dev->pdev, "Failed to decode EDID\n");
107 printk(BIOS_DEBUG, "Assuming VGA for KVM\n");
108
109 memset(edid, 0, sizeof(*edid));
110
111 edid->mode.pixel_clock = 6411;
112 edid->mode.refresh = 60;
113 edid->mode.ha = 1024;
114 edid->mode.hspw = 4;
115 edid->mode.hso = 56;
116 edid->mode.hbl = 264;
117 edid->mode.phsync = '-';
118
119 edid->mode.va = 768;
120 edid->mode.vspw = 3;
121 edid->mode.vso = 1;
122 edid->mode.vbl = 26;
123 edid->mode.pvsync = '+';
124 }
125
126 printk(BIOS_DEBUG, "AST: Display has %dpx x %dpx\n", edid->mode.ha, edid->mode.va);
127
128 widescreen = !!(((edid->mode.ha * 4) % (edid->mode.va * 3)));
129
130 while (ast_mode_valid(connector, edid->mode.ha, edid->mode.va) != MODE_OK) {
131 /* Select a compatible smaller mode */
132 if (edid->mode.ha > 1920 && widescreen) {
133 edid->mode.ha = 1920;
134 edid->mode.va = 1080;
135 } else if (edid->mode.ha >= 1920 && widescreen) {
136 edid->mode.ha = 1680;
137 edid->mode.va = 1050;
138 } else if (edid->mode.ha >= 1680 && widescreen) {
139 edid->mode.ha = 1600;
140 edid->mode.va = 900;
141 } else if (edid->mode.ha >= 1680 && !widescreen) {
142 edid->mode.ha = 1600;
143 edid->mode.va = 1200;
144 } else if (edid->mode.ha >= 1600 && widescreen) {
145 edid->mode.ha = 1440;
146 edid->mode.va = 900;
147 } else if (edid->mode.ha >= 1440 && widescreen) {
148 edid->mode.ha = 1360;
149 edid->mode.va = 768;
150 } else if (edid->mode.ha >= 1360 && widescreen) {
151 edid->mode.ha = 1280;
152 edid->mode.va = 800;
153 } else if (edid->mode.ha >= 1360 && !widescreen) {
154 edid->mode.ha = 1280;
155 edid->mode.va = 1024;
156 } else if (edid->mode.ha >= 1280) {
157 edid->mode.ha = 1024;
158 edid->mode.va = 768;
159 } else if (edid->mode.ha >= 1024) {
160 edid->mode.ha = 800;
161 edid->mode.va = 600;
162 } else if (edid->mode.ha >= 800) {
163 edid->mode.ha = 640;
164 edid->mode.va = 480;
165 } else {
166 dev_err(dev->pdev, "No compatible mode found.\n");
167
168 return -EIO;
169 }
170 };
171
172 return 0;
173 }
174
ast_driver_framebuffer_init(struct drm_device * dev,int flags)175 int ast_driver_framebuffer_init(struct drm_device *dev, int flags)
176 {
177 struct drm_display_mode adjusted_mode;
178 struct drm_crtc crtc;
179 struct drm_format format;
180 struct drm_primary primary;
181 struct drm_framebuffer fb;
182 struct drm_connector connector;
183 struct edid edid;
184 int ret;
185
186 /* Init wrapper structs */
187 connector.dev = dev;
188
189 format.cpp[0] = 4; /* 32 BPP */
190 fb.format = &format;
191
192 primary.fb = &fb;
193
194 crtc.dev = dev;
195 crtc.primary = &primary;
196
197 /* Read EDID and find mode */
198 ret = ast_select_mode(&connector, &edid);
199 if (ret) {
200 dev_err(dev->pdev, "Failed to select mode.\n");
201 return ret;
202 }
203
204 /* Updated edid for fb_fill_framebuffer_info */
205 edid.x_resolution = edid.mode.ha;
206 edid.y_resolution = edid.mode.va;
207 edid.framebuffer_bits_per_pixel = format.cpp[0] * 8;
208 edid.bytes_per_line = ALIGN_UP(edid.x_resolution * format.cpp[0], 8);
209
210 /* Updated framebuffer info for ast_crtc_mode_set */
211 fb.pitches[0] = edid.bytes_per_line;
212
213 printk(BIOS_DEBUG, "Using framebuffer %dpx x %dpx pitch %d @ %d BPP\n",
214 edid.x_resolution, edid.y_resolution, edid.bytes_per_line,
215 edid.framebuffer_bits_per_pixel);
216
217 /* Convert EDID to AST DRM mode */
218 ast_edid_to_drmmode(&edid, &crtc.mode);
219
220 memcpy(&adjusted_mode, &crtc.mode, sizeof(crtc.mode));
221
222 ret = ast_crtc_mode_set(&crtc, &crtc.mode, &adjusted_mode);
223 if (ret) {
224 dev_err(dev->pdev, "Failed to set mode.\n");
225 return ret;
226 }
227
228 ast_hide_cursor(&crtc);
229
230 /* Advertise new mode */
231 fb_new_framebuffer_info_from_edid(&edid, fb.mmio_addr);
232
233 /* Clear display */
234 memset((void *)(uintptr_t)fb.mmio_addr, 0, edid.bytes_per_line * edid.y_resolution);
235
236 return 0;
237 }
238