blob: 1def7e9ea9f4df6e9f80561028c75aa01bef92cc [file] [log] [blame]
Nico Huber83693c82016-10-08 22:17:55 +02001--
Nico Huber9a4c4c32019-09-16 22:05:11 +02002-- Copyright (C) 2014-2019 secunet Security Networks AG
Nico Huber2b6f6992017-07-09 18:11:34 +02003-- Copyright (C) 2017 Nico Huber <nico.h@gmx.de>
Nico Huber83693c82016-10-08 22:17:55 +02004--
5-- This program is free software; you can redistribute it and/or modify
6-- it under the terms of the GNU General Public License as published by
Nico Huber125a29e2016-10-18 00:23:54 +02007-- the Free Software Foundation; either version 2 of the License, or
8-- (at your option) any later version.
Nico Huber83693c82016-10-08 22:17:55 +02009--
10-- This program is distributed in the hope that it will be useful,
11-- but WITHOUT ANY WARRANTY; without even the implied warranty of
12-- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13-- GNU General Public License for more details.
14--
15
Nico Huber2b6f6992017-07-09 18:11:34 +020016with HW.MMIO_Range;
17pragma Elaborate_All (HW.MMIO_Range);
18with HW.PCI.Dev;
19pragma Elaborate_All (HW.PCI.Dev);
20
Nico Huber83693c82016-10-08 22:17:55 +020021with HW.GFX.GMA.Config;
Nico Huber8c45bcf2016-11-20 17:30:57 +010022with HW.GFX.GMA.Config_Helpers;
Nico Huber83693c82016-10-08 22:17:55 +020023with HW.GFX.GMA.Registers;
Nico Huber312433c2019-09-28 03:15:48 +020024with HW.GFX.GMA.PCode;
Nico Huber83693c82016-10-08 22:17:55 +020025with HW.GFX.GMA.Power_And_Clocks;
26with HW.GFX.GMA.Panel;
27with HW.GFX.GMA.PLLs;
28with HW.GFX.GMA.Port_Detect;
29with HW.GFX.GMA.Connectors;
30with HW.GFX.GMA.Connector_Info;
31with HW.GFX.GMA.Pipe_Setup;
32
Nico Huber83693c82016-10-08 22:17:55 +020033with HW.Debug;
34with GNAT.Source_Info;
35
Nico Huber83693c82016-10-08 22:17:55 +020036
37package body HW.GFX.GMA
38 with Refined_State =>
39 (State =>
Nico Hubere317e9c2019-09-29 03:03:18 +020040 (Config.Variable,
41 PCI_Usable,
Nico Huberc5c66ec2019-09-28 23:59:45 +020042 Dev.Address_State,
Nico Huber2b6f6992017-07-09 18:11:34 +020043 Registers.Address_State,
Nico Huber312433c2019-09-28 03:15:48 +020044 PCode.Mailbox_Ready,
Nico Huber83693c82016-10-08 22:17:55 +020045 PLLs.State, Panel.Panel_State,
Nico Huber1a712d32017-01-09 15:11:04 +010046 Cur_Configs, Allocated_PLLs,
Nico Huberc3f66f62017-07-16 21:39:54 +020047 HPD_Delay, Wait_For_HPD,
48 Linear_FB_Base),
Nico Huber83693c82016-10-08 22:17:55 +020049 Init_State => Initialized,
Nico Huber83693c82016-10-08 22:17:55 +020050 Device_State =>
Nico Huber2b6f6992017-07-09 18:11:34 +020051 (Dev.PCI_State, Registers.Register_State, Registers.GTT_State))
Nico Huber83693c82016-10-08 22:17:55 +020052is
Nico Huber2b6f6992017-07-09 18:11:34 +020053 pragma Disable_Atomic_Synchronization;
Nico Huber83693c82016-10-08 22:17:55 +020054
Nico Huberad096092024-07-02 18:45:44 +020055 subtype Port_Name is String (1 .. 8);
Nico Huber83693c82016-10-08 22:17:55 +020056 type Port_Name_Array is array (Port_Type) of Port_Name;
57 Port_Names : constant Port_Name_Array :=
Nico Huberad096092024-07-02 18:45:44 +020058 (Disabled => "Disabled",
59 LVDS => "LVDS ",
60 eDP => "eDP ",
61 DP1 => "DP1 ",
62 DP2 => "DP2 ",
63 DP3 => "DP3 ",
64 DP_TC1 => "DP_TC1 ",
65 DP_TC2 => "DP_TC2 ",
66 DP_TC3 => "DP_TC3 ",
67 DP_TC4 => "DP_TC4 ",
68 HDMI1 => "HDMI1 ",
69 HDMI2 => "HDMI2 ",
70 HDMI3 => "HDMI3 ",
71 HDMI_TC1 => "HDMI_TC1",
72 HDMI_TC2 => "HDMI_TC2",
73 HDMI_TC3 => "HDMI_TC3",
74 HDMI_TC4 => "HDMI_TC4",
75 Analog => "Analog ",
76 USBC1 => "USBC1 ",
77 USBC2 => "USBC2 ",
78 USBC3 => "USBC3 ",
79 USBC4 => "USBC4 ");
Nico Huber83693c82016-10-08 22:17:55 +020080
Nico Huber2b6f6992017-07-09 18:11:34 +020081 package Dev is new HW.PCI.Dev (PCI.Address'(0, 2, 0));
82
Nico Huber83693c82016-10-08 22:17:55 +020083 package Display_Controller renames Pipe_Setup;
84
Nico Huber99f10f32016-11-20 00:34:05 +010085 type PLLs_Type is array (Pipe_Index) of PLLs.T;
Nico Huber83693c82016-10-08 22:17:55 +020086
Nico Huber83693c82016-10-08 22:17:55 +020087 type HPD_Type is array (Port_Type) of Boolean;
Nico Huber3be61d42017-01-09 13:58:18 +010088 type HPD_Delay_Type is array (Active_Port_Type) of Time.T;
Nico Huber83693c82016-10-08 22:17:55 +020089
Nico Huber83693c82016-10-08 22:17:55 +020090 Allocated_PLLs : PLLs_Type;
Nico Huber83693c82016-10-08 22:17:55 +020091 HPD_Delay : HPD_Delay_Type;
92 Wait_For_HPD : HPD_Type;
93 Initialized : Boolean := False;
94
Nico Huberc3f66f62017-07-16 21:39:54 +020095 Linear_FB_Base : Word64;
96
Nico Huber83693c82016-10-08 22:17:55 +020097 ----------------------------------------------------------------------------
98
Tim Wawrzynczakfc49b602022-09-09 10:29:24 -060099 ICP_RAWCLK_NUM : constant := 1 * 2 ** 11;
100
101 function PCH_RAWCLK_FREQ_MASK return Word32 is
102 Mask : Word32;
103 begin
104 if Config.Need_Rawclk_Numerator then
105 Mask := 16#ffff_ffff#;
106 elsif Config.Has_Fractional_RawClk then
107 Mask := 16#3fff# * 2 ** 16;
108 else
109 Mask := 16#3ff# * 2 ** 0;
110 end if;
111 return Mask;
112 end PCH_RAWCLK_FREQ_MASK;
Nico Huberf54d0962016-10-20 14:17:18 +0200113
114 function PCH_RAWCLK_FREQ (Freq : Frequency_Type) return Word32
115 is
116 begin
Nico Huberdde06302020-12-20 02:18:30 +0100117 if Config.Has_Fractional_RawClk then
118 declare
119 Fraction_K : constant Int64 := Freq / 1_000 mod 1_000;
120 Freq32 : Word32 := Shift_Left (Word32 (Freq / 1_000_000), 16);
121 begin
122 if Fraction_K /= 0 then
123 Freq32 := Freq32 or Shift_Left
124 (Word32 (Div_Round_Closest (1_000, Fraction_K) - 1), 26);
125 end if;
Tim Wawrzynczakfc49b602022-09-09 10:29:24 -0600126
127 if Config.Need_Rawclk_Numerator then
128 Freq32 := Freq32 or ICP_RAWCLK_NUM;
129 end if;
Nico Huberdde06302020-12-20 02:18:30 +0100130 return Freq32;
131 end;
132 else
133 return Word32 (Freq / 1_000_000);
134 end if;
Nico Huberf54d0962016-10-20 14:17:18 +0200135 end PCH_RAWCLK_FREQ;
136
137 ----------------------------------------------------------------------------
138
Nico Huber43370ba2017-01-09 15:26:19 +0100139 procedure Enable_Output
140 (Pipe : in Pipe_Index;
141 Pipe_Cfg : in Pipe_Config;
142 Success : out Boolean)
Nico Huber8a5a3b52018-06-04 14:42:13 +0200143 with
Nico Huber9a4c4c32019-09-16 22:05:11 +0200144 Pre =>
145 Pipe_Cfg.Port in Active_Port_Type and
146 Config_Helpers.Valid_FB (Pipe_Cfg.Framebuffer, Pipe_Cfg.Mode)
Nico Huber43370ba2017-01-09 15:26:19 +0100147 is
148 Port_Cfg : Port_Config;
149 begin
Nico Huber3be61d42017-01-09 13:58:18 +0100150 pragma Debug (Debug.New_Line);
151 pragma Debug (Debug.Put_Line
152 ("Trying to enable port " & Port_Names (Pipe_Cfg.Port)));
153
Nico Huber43370ba2017-01-09 15:26:19 +0100154 Config_Helpers.Fill_Port_Config
155 (Port_Cfg, Pipe, Pipe_Cfg.Port, Pipe_Cfg.Mode, Success);
156
157 if Success then
Nico Huber41e86742024-07-17 17:10:28 +0200158 Power_And_Clocks.Power_Up (Pipe_Cfg.Port, Success);
159 end if;
160
161 if Success then
Nico Huber43370ba2017-01-09 15:26:19 +0100162 Connector_Info.Preferred_Link_Setting (Port_Cfg, Success);
163 end if;
164
Nico Hubera8254482024-07-03 12:23:00 +0200165 if Success then
166 Connectors.Prepare (Pipe_Cfg.Port, Port_Cfg, Success);
167 end if;
168
Nico Huber43370ba2017-01-09 15:26:19 +0100169 -- loop over all possible DP-lane configurations
170 -- (non-DP ports use a single fake configuration)
171 while Success loop
172 pragma Loop_Invariant
173 (Pipe_Cfg.Port in Active_Port_Type and
174 Port_Cfg.Mode = Port_Cfg.Mode'Loop_Entry);
175
176 PLLs.Alloc
177 (Port_Cfg => Port_Cfg,
178 PLL => Allocated_PLLs (Pipe),
179 Success => Success);
180
181 if Success then
182 -- try each DP-lane configuration twice
183 for Try in 1 .. 2 loop
184 pragma Loop_Invariant
185 (Pipe_Cfg.Port in Active_Port_Type);
186
Nico Huber4798c662017-01-11 12:44:48 +0100187 -- Clear pending hot-plug events before every try
188 Port_Detect.Clear_Hotplug_Detect (Pipe_Cfg.Port);
189
Nico Huber43370ba2017-01-09 15:26:19 +0100190 Connectors.Pre_On
191 (Pipe => Pipe,
192 Port_Cfg => Port_Cfg,
193 PLL_Hint => PLLs.Register_Value (Allocated_PLLs (Pipe)),
194 Success => Success);
195
196 if Success then
197 Display_Controller.On
198 (Pipe => Pipe,
199 Port_Cfg => Port_Cfg,
Nico Huber4dc4c612018-01-10 15:55:09 +0100200 Framebuffer => Pipe_Cfg.Framebuffer,
201 Cursor => Pipe_Cfg.Cursor);
Nico Huber43370ba2017-01-09 15:26:19 +0100202
203 Connectors.Post_On
Arthur Heymans60d0e5f2018-03-28 17:08:27 +0200204 (Pipe => Pipe,
205 Port_Cfg => Port_Cfg,
Nico Huber43370ba2017-01-09 15:26:19 +0100206 PLL_Hint => PLLs.Register_Value (Allocated_PLLs (Pipe)),
207 Success => Success);
208
209 if not Success then
210 Display_Controller.Off (Pipe);
Nico Huberbfea6a32024-03-07 15:22:36 +0000211 Connectors.Post_Off (Pipe, Port_Cfg);
Nico Huber43370ba2017-01-09 15:26:19 +0100212 end if;
213 end if;
214
215 exit when Success;
216 end loop;
217 exit when Success; -- connection established => stop loop
218
219 -- connection failed
220 PLLs.Free (Allocated_PLLs (Pipe));
221 end if;
222
223 Connector_Info.Next_Link_Setting (Port_Cfg, Success);
Nico Hubera8254482024-07-03 12:23:00 +0200224 exit when not Success;
225
226 Connectors.Prepare (Pipe_Cfg.Port, Port_Cfg, Success);
Nico Huber43370ba2017-01-09 15:26:19 +0100227 end loop;
228
229 if Success then
230 pragma Debug (Debug.Put_Line
231 ("Enabled port " & Port_Names (Pipe_Cfg.Port)));
232 else
233 Wait_For_HPD (Pipe_Cfg.Port) := True;
Nico Huber2bbd6e72020-01-07 18:22:59 +0100234 Panel.Off (Config_Helpers.To_Panel (Pipe_Cfg.Port));
Nico Huber43370ba2017-01-09 15:26:19 +0100235 end if;
236 end Enable_Output;
237
Nico Huber3be61d42017-01-09 13:58:18 +0100238 procedure Disable_Output (Pipe : Pipe_Index; Pipe_Cfg : Pipe_Config)
239 is
240 Port_Cfg : Port_Config;
241 Success : Boolean;
242 begin
243 Config_Helpers.Fill_Port_Config
244 (Port_Cfg, Pipe, Pipe_Cfg.Port, Pipe_Cfg.Mode, Success);
245 if Success then
246 pragma Debug (Debug.New_Line);
247 pragma Debug (Debug.Put_Line
248 ("Disabling port " & Port_Names (Pipe_Cfg.Port)));
249 pragma Debug (Debug.New_Line);
250
Jeremy Compostellafe80fbb2023-01-11 14:05:42 -0700251 if Pipe_Cfg.Framebuffer.Offset = VGA_PLANE_FRAMEBUFFER_OFFSET then
252 Display_Controller.Legacy_VGA_Off;
253 end if;
254
Nico Huberbfea6a32024-03-07 15:22:36 +0000255 Connectors.Pre_Off (Pipe, Port_Cfg);
Nico Huber3be61d42017-01-09 13:58:18 +0100256 Display_Controller.Off (Pipe);
Nico Huberbfea6a32024-03-07 15:22:36 +0000257 Connectors.Post_Off (Pipe, Port_Cfg);
Nico Huber3be61d42017-01-09 13:58:18 +0100258
259 PLLs.Free (Allocated_PLLs (Pipe));
260 end if;
261 end Disable_Output;
262
Nico Huber99f10f32016-11-20 00:34:05 +0100263 procedure Update_Outputs (Configs : Pipe_Configs)
Nico Huber83693c82016-10-08 22:17:55 +0200264 is
Nico Huber3be61d42017-01-09 13:58:18 +0100265 procedure Check_HPD (Port : in Active_Port_Type; Detected : out Boolean)
266 is
267 HPD_Delay_Over : constant Boolean := Time.Timed_Out (HPD_Delay (Port));
268 begin
269 if HPD_Delay_Over then
270 Port_Detect.Hotplug_Detect (Port, Detected);
271 HPD_Delay (Port) := Time.MS_From_Now (333);
272 else
273 Detected := False;
274 end if;
275 end Check_HPD;
Nico Huberb56b9c52017-01-11 15:12:23 +0100276
Nico Huber9a4c4c32019-09-16 22:05:11 +0200277 Scaler_Reservation : Display_Controller.Scaler_Reservation :=
278 Display_Controller.Null_Scaler_Reservation;
Nico Huber564103f2017-01-11 15:33:07 +0100279
Nico Huber9a4c4c32019-09-16 22:05:11 +0200280 Update_Power : Boolean := False;
Nico Huberb0bbdbc2019-09-27 22:32:21 +0200281 Update_CDClk : Boolean;
Nico Huber9a4c4c32019-09-16 22:05:11 +0200282 Old_Configs,
283 New_Configs : Pipe_Configs;
Nico Huber3d06de82018-05-29 01:35:04 +0200284
285 function Full_Update (Cur_Config, New_Config : Pipe_Config) return Boolean
286 is
287 begin
288 return
Nico Huber958c5642018-06-02 16:59:31 +0200289 Cur_Config.Port /= New_Config.Port
290 or else
291 Cur_Config.Mode /= New_Config.Mode
292 or else
Nico Huber3d06de82018-05-29 01:35:04 +0200293 (Config.Use_PDW_For_EDP_Scaling and then
Nico Huber8beafd72020-01-07 14:59:44 +0100294 (Cur_Config.Port = eDP and
Nico Huber958c5642018-06-02 16:59:31 +0200295 Requires_Scaling (Cur_Config) /= Requires_Scaling (New_Config)))
296 or else
297 (Config.Has_GMCH_PFIT_CONTROL and then
298 (Requires_Scaling (Cur_Config) /= Requires_Scaling (New_Config) or
299 Scaling_Type (Cur_Config) /= Scaling_Type (New_Config)));
Nico Huber3d06de82018-05-29 01:35:04 +0200300 end Full_Update;
Nico Huber83693c82016-10-08 22:17:55 +0200301 begin
302 Old_Configs := Cur_Configs;
Nico Huber9a4c4c32019-09-16 22:05:11 +0200303 New_Configs := Configs;
304
305 -- validate new configs, filter invalid configs and those waiting for HPD
306 for Pipe in Pipe_Index loop
307 declare
308 Success : Boolean := True;
309 Cur_Config : Pipe_Config renames Cur_Configs (Pipe);
310 New_Config : Pipe_Config renames New_Configs (Pipe);
311 begin
312 if New_Config.Port /= Disabled then
313 if Wait_For_HPD (New_Config.Port) then
314 Check_HPD (New_Config.Port, Success);
315 Wait_For_HPD (New_Config.Port) := not Success;
316 end if;
317
318 Success := Success and then
319 Config_Helpers.Validate_Config
320 (New_Config.Framebuffer, New_Config.Mode, Pipe);
321
322 if Success and then Requires_Scaling (New_Config) then
323 Display_Controller.Reserve_Scaler
324 (Success, Scaler_Reservation, Pipe);
325 end if;
326
327 if not Success then
328 New_Config.Port := Disabled;
329 end if;
330 end if;
331 end;
332 pragma Loop_Invariant
333 (for all P in Pipe_Index'First .. Pipe =>
334 New_Configs (P).Port = Disabled or
335 Config_Helpers.Valid_FB
336 (New_Configs (P).Framebuffer, New_Configs (P).Mode));
337 end loop;
Nico Huber83693c82016-10-08 22:17:55 +0200338
Nico Huberb0bbdbc2019-09-27 22:32:21 +0200339 -- limit dotclocks to maximum CDClk, if we are about
340 -- to switch CDClk, all pipes have to be disabled
341 Power_And_Clocks.Limit_Dotclocks (New_Configs, Update_CDClk);
342
Nico Huberb56b9c52017-01-11 15:12:23 +0100343 -- disable all pipes that changed or had a hot-plug event
344 for Pipe in Pipe_Index loop
345 declare
346 Unplug_Detected : Boolean;
347 Cur_Config : Pipe_Config renames Cur_Configs (Pipe);
Nico Huber9a4c4c32019-09-16 22:05:11 +0200348 New_Config : Pipe_Config renames New_Configs (Pipe);
Nico Huberb56b9c52017-01-11 15:12:23 +0100349 begin
350 if Cur_Config.Port /= Disabled then
351 Check_HPD (Cur_Config.Port, Unplug_Detected);
Nico Huber83693c82016-10-08 22:17:55 +0200352
Nico Huberb0bbdbc2019-09-27 22:32:21 +0200353 if Update_CDClk or
354 Unplug_Detected or
355 Full_Update (Cur_Config, New_Config)
356 then
Nico Huberb56b9c52017-01-11 15:12:23 +0100357 Disable_Output (Pipe, Cur_Config);
358 Cur_Config.Port := Disabled;
Nico Huber9a4c4c32019-09-16 22:05:11 +0200359 Update_Power := True;
Nico Huberb56b9c52017-01-11 15:12:23 +0100360 end if;
Nico Huber83693c82016-10-08 22:17:55 +0200361 end if;
Nico Huberb56b9c52017-01-11 15:12:23 +0100362 end;
363 end loop;
Nico Huber83693c82016-10-08 22:17:55 +0200364
Nico Huberb0bbdbc2019-09-27 22:32:21 +0200365 -- switch CDClk if necessary and possible, limit dotclocks accordingly
366 if Update_CDClk then
367 Power_And_Clocks.Update_CDClk (New_Configs);
368 end if;
369
Nico Huberb56b9c52017-01-11 15:12:23 +0100370 -- enable all pipes that changed and should be active
371 for Pipe in Pipe_Index loop
372 declare
373 Success : Boolean;
374 Cur_Config : Pipe_Config renames Cur_Configs (Pipe);
Nico Huber9a4c4c32019-09-16 22:05:11 +0200375 New_Config : Pipe_Config renames New_Configs (Pipe);
Nico Huberb56b9c52017-01-11 15:12:23 +0100376 begin
Nico Huber9a4c4c32019-09-16 22:05:11 +0200377 -- full update
Nico Huber3d06de82018-05-29 01:35:04 +0200378 if New_Config.Port /= Disabled and
379 Full_Update (Cur_Config, New_Config)
Nico Huberb56b9c52017-01-11 15:12:23 +0100380 then
Nico Huber9a4c4c32019-09-16 22:05:11 +0200381 Power_And_Clocks.Power_Up (Old_Configs, New_Configs);
382 Update_Power := True;
Nico Huberc7a4fee2016-11-03 18:18:03 +0100383
Nico Huber9a4c4c32019-09-16 22:05:11 +0200384 Enable_Output (Pipe, New_Config, Success);
Nico Huber83693c82016-10-08 22:17:55 +0200385 if Success then
Nico Huberb56b9c52017-01-11 15:12:23 +0100386 Cur_Config := New_Config;
Nico Huber83693c82016-10-08 22:17:55 +0200387 end if;
Nico Huber3be61d42017-01-09 13:58:18 +0100388
Nico Huberb56b9c52017-01-11 15:12:23 +0100389 -- update framebuffer offset only
390 elsif New_Config.Port /= Disabled and
Nico Huberf361ec82018-06-02 18:01:45 +0200391 Cur_Config.Framebuffer /= New_Config.Framebuffer
Nico Huberb56b9c52017-01-11 15:12:23 +0100392 then
Nico Huber9a4c4c32019-09-16 22:05:11 +0200393 Display_Controller.Setup_FB
394 (Pipe, New_Config.Mode, New_Config.Framebuffer);
395 Display_Controller.Update_Cursor
396 (Pipe, New_Config.Framebuffer, New_Config.Cursor);
397 Cur_Config := New_Config;
Nico Huberb56b9c52017-01-11 15:12:23 +0100398 end if;
399 end;
Nico Huber83693c82016-10-08 22:17:55 +0200400 end loop;
401
Nico Huber9a4c4c32019-09-16 22:05:11 +0200402 if Update_Power then
403 Power_And_Clocks.Power_Down (Old_Configs, New_Configs, Cur_Configs);
Nico Huber83693c82016-10-08 22:17:55 +0200404 end if;
Nico Huber83693c82016-10-08 22:17:55 +0200405 end Update_Outputs;
406
407 ----------------------------------------------------------------------------
408
Nico Huber15ffc4f2018-01-11 14:44:43 +0100409 procedure Update_Cursor (Pipe : Pipe_Index; Cursor : Cursor_Type)
410 is
411 begin
412 Cur_Configs (Pipe).Cursor := Cursor;
413 Display_Controller.Update_Cursor
414 (Pipe, Cur_Configs (Pipe).Framebuffer, Cur_Configs (Pipe).Cursor);
415 end Update_Cursor;
416
417 procedure Place_Cursor
418 (Pipe : Pipe_Index;
419 X : Cursor_Pos;
420 Y : Cursor_Pos)
421 is
422 begin
423 Cur_Configs (Pipe).Cursor.Center_X := X;
424 Cur_Configs (Pipe).Cursor.Center_Y := Y;
425 Display_Controller.Place_Cursor
426 (Pipe, Cur_Configs (Pipe).Framebuffer, Cur_Configs (Pipe).Cursor);
427 end Place_Cursor;
428
429 procedure Move_Cursor
430 (Pipe : Pipe_Index;
431 X : Cursor_Pos;
432 Y : Cursor_Pos)
433 is
434 function Cap_Add (A, B : Cursor_Pos) return Cursor_Pos is
435 (if A + B < 0
436 then Int32'Max (Cursor_Pos'First, A + B)
437 else Int32'Min (Cursor_Pos'Last, A + B));
438 begin
439 Place_Cursor
440 (Pipe => Pipe,
441 X => Cap_Add (Cur_Configs (Pipe).Cursor.Center_X, X),
442 Y => Cap_Add (Cur_Configs (Pipe).Cursor.Center_Y, Y));
443 end Move_Cursor;
444
445 ----------------------------------------------------------------------------
446
Nico Huberbc0588e2020-07-21 12:17:19 +0200447 procedure Backlight_On (Port : Active_Port_Type)
448 with
449 Refined_Global => (In_Out => Registers.Register_State)
450 is
451 begin
452 Panel.Backlight_On (Config_Helpers.To_Panel (Port));
453 end Backlight_On;
454
455 procedure Backlight_Off (Port : Active_Port_Type)
456 with
457 Refined_Global => (In_Out => Registers.Register_State)
458 is
459 begin
460 Panel.Backlight_Off (Config_Helpers.To_Panel (Port));
461 end Backlight_Off;
462
463 procedure Set_Brightness (Port : Active_Port_Type; Level : Word32)
464 with
465 Refined_Global => (In_Out => Registers.Register_State)
466 is
467 begin
468 Panel.Set_Backlight (Config_Helpers.To_Panel (Port), Level);
469 end Set_Brightness;
470
471 procedure Get_Max_Brightness (Port : Active_Port_Type; Level : out Word32)
472 with
473 Refined_Global => (In_Out => Registers.Register_State)
474 is
475 begin
476 Panel.Get_Max_Backlight (Config_Helpers.To_Panel (Port), Level);
477 end Get_Max_Brightness;
478
479 ----------------------------------------------------------------------------
480
Nico Huber793f4f82022-09-04 14:24:00 +0000481 pragma Warnings
482 (GNATprove, Off, """Registers.GTT_State"" * is not modified*",
483 Reason => "The whole, abstract Device_State is modified in certain configurations.");
484 pragma Warnings
485 (GNATprove, Off, "no check message justified*", Reason => "see below");
Nico Huber83693c82016-10-08 22:17:55 +0200486 procedure Initialize
Nico Huber2b6f6992017-07-09 18:11:34 +0200487 (Write_Delay : in Word64 := 0;
Nico Huber793a8d42016-11-21 18:57:03 +0100488 Clean_State : in Boolean := False;
Nico Huber83693c82016-10-08 22:17:55 +0200489 Success : out Boolean)
490 with
491 Refined_Global =>
Nico Huber27088aa2018-06-10 13:28:05 +0200492 (Input => (Time.State),
Nico Huber793f4f82022-09-04 14:24:00 +0000493 In_Out =>
494 (Dev.PCI_State, Port_IO.State,
495 Registers.Register_State, Registers.GTT_State),
Nico Huber83693c82016-10-08 22:17:55 +0200496 Output =>
Nico Huberc5c66ec2019-09-28 23:59:45 +0200497 (PCI_Usable,
498 Config.Variable,
Nico Huber27088aa2018-06-10 13:28:05 +0200499 Dev.Address_State,
Nico Huber2b6f6992017-07-09 18:11:34 +0200500 Registers.Address_State,
Nico Huber312433c2019-09-28 03:15:48 +0200501 PCode.Mailbox_Ready,
Nico Huber83693c82016-10-08 22:17:55 +0200502 PLLs.State, Panel.Panel_State,
Nico Huber1a712d32017-01-09 15:11:04 +0100503 Cur_Configs, Allocated_PLLs,
Nico Huberc3f66f62017-07-16 21:39:54 +0200504 HPD_Delay, Wait_For_HPD,
505 Linear_FB_Base, Initialized))
Nico Huber83693c82016-10-08 22:17:55 +0200506 is
507 use type HW.Word64;
508
Nico Huber0b2329a2018-06-09 21:14:27 +0200509 function MMIO_GTT_Offset return Natural is
Arthur Heymans960e2392026-03-03 19:45:24 +0100510 (if Config.Has_I945_GTT_BAR
511 then 0 -- i945: GTT is on separate BAR3, not within BAR0
512 elsif Config.Has_64bit_GTT
Nico Huber0b2329a2018-06-09 21:14:27 +0200513 then Registers.MMIO_GTT_64_Offset
514 else Registers.MMIO_GTT_32_Offset);
Nico Huber2b6f6992017-07-09 18:11:34 +0200515 PCI_MMIO_Base, PCI_GTT_Base : Word64;
516
Nico Huber83693c82016-10-08 22:17:55 +0200517 Now : constant Time.T := Time.Now;
518
519 procedure Check_Platform (Success : out Boolean)
520 is
521 Audio_VID_DID : Word32;
522 begin
Arthur Heymans960e2392026-03-03 19:45:24 +0100523 if Config.Gen_I945 then
524 -- i945 has no integrated audio DID to verify
525 Success := True;
526 return;
527 end if;
Nico Huber6621a142018-06-07 23:56:54 +0200528 case Config.Gen is
Arthur Heymans960e2392026-03-03 19:45:24 +0100529 when I945 =>
530 Audio_VID_DID := 0; -- unreachable due to early return
Arthur Heymans73ea0322018-03-28 17:17:07 +0200531 when G45 =>
532 Registers.Read (Registers.G4X_AUD_VID_DID, Audio_VID_DID);
Nico Huber6621a142018-06-07 23:56:54 +0200533 when Ironlake =>
534 Registers.Read (Registers.PCH_AUD_VID_DID, Audio_VID_DID);
Tim Wawrzynczak605660b2022-06-08 12:48:19 -0600535 when Haswell .. Tigerlake =>
Nico Huber83693c82016-10-08 22:17:55 +0200536 Registers.Read (Registers.AUD_VID_DID, Audio_VID_DID);
Nico Huber83693c82016-10-08 22:17:55 +0200537 end case;
538 Success :=
Nico Huber998ee2b2018-06-12 23:02:17 +0200539 ((Config.Gen_Broxton and Audio_VID_DID = 16#8086_280a#) or
Nico Huber88badbe2018-09-27 16:36:47 +0200540 (Config.CPU_Kabylake and Audio_VID_DID = 16#8086_280b#) or
541 (Config.CPU_Skylake and Audio_VID_DID = 16#8086_2809#) or
Nico Huber998ee2b2018-06-12 23:02:17 +0200542 (Config.CPU_Broadwell and Audio_VID_DID = 16#8086_2808#) or
543 (Config.CPU_Haswell and Audio_VID_DID = 16#8086_2807#) or
544 ((Config.CPU_Ivybridge or
545 Config.CPU_Sandybridge) and (Audio_VID_DID = 16#8086_2806# or
546 Audio_VID_DID = 16#8086_2805#)) or
547 (Config.CPU_Ironlake and Audio_VID_DID = 16#0000_0000#) or
548 (Config.Gen_G45 and (Audio_VID_DID = 16#8086_2801# or
549 Audio_VID_DID = 16#8086_2802# or
Tim Wawrzynczak605660b2022-06-08 12:48:19 -0600550 Audio_VID_DID = 16#8086_2803#)) or
551 (Config.CPU_Tigerlake and (Audio_VID_DID = 16#8086_2812#)));
Nico Huber83693c82016-10-08 22:17:55 +0200552 end Check_Platform;
Nico Hubere7ac6eb2017-09-04 23:54:13 +0200553
554 procedure Check_Platform_PCI (Success : out Boolean)
555 is
556 use type HW.Word16;
557 Vendor, Device : Word16;
558 begin
559 Dev.Read16 (Vendor, PCI.Vendor_Id);
560 Dev.Read16 (Device, PCI.Device_Id);
561
Nico Huber6a996dc2018-06-17 16:30:33 +0200562 Config.Detect_CPU (Device);
Nico Hubere7ac6eb2017-09-04 23:54:13 +0200563 Success := Vendor = 16#8086# and Config.Compatible_GPU (Device);
564 end Check_Platform_PCI;
Nico Huber83693c82016-10-08 22:17:55 +0200565 begin
Nico Huber83693c82016-10-08 22:17:55 +0200566 pragma Debug (Debug.Put_Line (GNAT.Source_Info.Enclosing_Entity));
567
568 pragma Debug (Debug.Set_Register_Write_Delay (Write_Delay));
569
Nico Huberc5c66ec2019-09-28 23:59:45 +0200570 PCI_Usable := False;
Nico Huberc3f66f62017-07-16 21:39:54 +0200571 Linear_FB_Base := 0;
Nico Huber312433c2019-09-28 03:15:48 +0200572 PCode.Mailbox_Ready := False;
Nico Huber83693c82016-10-08 22:17:55 +0200573 Wait_For_HPD := HPD_Type'(others => False);
574 HPD_Delay := HPD_Delay_Type'(others => Now);
Nico Huber83693c82016-10-08 22:17:55 +0200575 Allocated_PLLs := (others => PLLs.Invalid);
Nico Huber99f10f32016-11-20 00:34:05 +0100576 Cur_Configs := Pipe_Configs'
577 (others => Pipe_Config'
Nico Huber83693c82016-10-08 22:17:55 +0200578 (Port => Disabled,
579 Framebuffer => HW.GFX.Default_FB,
Nico Hubera02b2c62018-01-09 15:58:34 +0100580 Cursor => Default_Cursor,
Nico Huber83693c82016-10-08 22:17:55 +0200581 Mode => HW.GFX.Invalid_Mode));
Nico Huber27088aa2018-06-10 13:28:05 +0200582 Config.Variable := Config.Initial_Settings;
Nico Huber6a996dc2018-06-17 16:30:33 +0200583 Registers.Set_Register_Base (Config.Default_MMIO_Base);
Nico Huber83693c82016-10-08 22:17:55 +0200584 PLLs.Initialize;
585
Nico Huber2b6f6992017-07-09 18:11:34 +0200586 Dev.Initialize (Success);
587
588 if Success then
Nico Huber6a996dc2018-06-17 16:30:33 +0200589 Check_Platform_PCI (Success);
Nico Hubere7ac6eb2017-09-04 23:54:13 +0200590 if Success then
Arthur Heymans960e2392026-03-03 19:45:24 +0100591 if Config.Has_I945_GTT_BAR then
592 -- i945: MMIO is on BAR0, GTT is on separate BAR3
593 Dev.Map (PCI_MMIO_Base, PCI.Res0);
594 Dev.Map (PCI_GTT_Base, PCI.Res3);
595 else
596 Dev.Map (PCI_MMIO_Base, PCI.Res0, Length => MMIO_GTT_Offset);
597 Dev.Map (PCI_GTT_Base, PCI.Res0, Offset => MMIO_GTT_Offset);
598 end if;
Nico Huber6a996dc2018-06-17 16:30:33 +0200599 if PCI_MMIO_Base /= 0 and PCI_GTT_Base /= 0 then
600 Registers.Set_Register_Base (PCI_MMIO_Base, PCI_GTT_Base);
Nico Huberc5c66ec2019-09-28 23:59:45 +0200601 PCI_Usable := True;
Nico Huber6a996dc2018-06-17 16:30:33 +0200602 else
603 pragma Debug (Debug.Put_Line
Arthur Heymans960e2392026-03-03 19:45:24 +0100604 ("ERROR: Couldn't map resource0."));
Nico Huber6a996dc2018-06-17 16:30:33 +0200605 Success := Config.Default_MMIO_Base_Set;
606 end if;
Nico Hubere7ac6eb2017-09-04 23:54:13 +0200607 end if;
Nico Huber2b6f6992017-07-09 18:11:34 +0200608 else
609 pragma Debug (Debug.Put_Line
610 ("WARNING: Couldn't initialize PCI dev."));
Nico Huber2b6f6992017-07-09 18:11:34 +0200611 Success := Config.Default_MMIO_Base_Set;
Nico Huber2b6f6992017-07-09 18:11:34 +0200612
Nico Hubere7ac6eb2017-09-04 23:54:13 +0200613 if Success then
614 Check_Platform (Success);
615 end if;
Nico Huber2b6f6992017-07-09 18:11:34 +0200616 end if;
617
Nico Huber5dbaf4b2020-01-08 17:24:58 +0100618 Panel.Static_Init; -- early for flow analysis
619
Nico Huber83693c82016-10-08 22:17:55 +0200620 if not Success then
621 pragma Debug (Debug.Put_Line ("ERROR: Incompatible CPU or PCH."));
622
Nico Huber83693c82016-10-08 22:17:55 +0200623 Initialized := False;
624 return;
625 end if;
626
627 Panel.Setup_PP_Sequencer;
Nico Huber83693c82016-10-08 22:17:55 +0200628
Nico Huber793a8d42016-11-21 18:57:03 +0100629 if Clean_State then
630 Power_And_Clocks.Pre_All_Off;
631 Connectors.Pre_All_Off;
632 Display_Controller.All_Off;
633 Connectors.Post_All_Off;
634 PLLs.All_Off;
635 Power_And_Clocks.Post_All_Off;
Nico Huber17d64b62017-07-15 20:51:25 +0200636 Registers.Clear_Fences;
Nico Huber33912aa2016-12-06 20:36:23 +0100637 else
638 -- According to PRMs, VGA plane is the only thing
Nico Huber3a0e2a02017-07-19 14:41:46 +0200639 -- that's enabled by default after reset...
Nico Huber33912aa2016-12-06 20:36:23 +0100640 Display_Controller.Legacy_VGA_Off;
Nico Huber3a0e2a02017-07-19 14:41:46 +0200641 -- ... along with some DDI port bits since Skylake.
642 Connectors.Post_Reset_Off;
Nico Huber793a8d42016-11-21 18:57:03 +0100643 end if;
Nico Huber83693c82016-10-08 22:17:55 +0200644
645 -------------------- Now restart from a clean state ---------------------
646 Power_And_Clocks.Initialize;
Nico Huber1b991852024-07-17 16:44:05 +0200647 Port_Detect.Initialize;
648 Connectors.Initialize;
Nico Huber83693c82016-10-08 22:17:55 +0200649
Nico Huber1c3b9282017-02-09 13:57:04 +0100650 if Config.Has_PCH then
651 Registers.Unset_And_Set_Mask
652 (Register => Registers.PCH_RAWCLK_FREQ,
653 Mask_Unset => PCH_RAWCLK_FREQ_MASK,
Nico Huberc9ad9de2020-12-20 02:34:37 +0100654 Mask_Set => PCH_RAWCLK_FREQ (Config.Raw_Clock));
Nico Huber1c3b9282017-02-09 13:57:04 +0100655 end if;
Nico Huberf54d0962016-10-20 14:17:18 +0200656
Nico Huber83693c82016-10-08 22:17:55 +0200657 Initialized := True;
658
659 end Initialize;
Nico Huber793f4f82022-09-04 14:24:00 +0000660 pragma Annotate
661 (GNATprove, Intentional, "unused global",
662 "The whole, abstract Device_State is modified in certain configurations.");
663 pragma Warnings (GNATprove, On, "no check message justified*");
664 pragma Warnings
665 (GNATprove, On, """Registers.GTT_State"" * is not modified*");
Nico Huber83693c82016-10-08 22:17:55 +0200666
667 function Is_Initialized return Boolean
668 with
669 Refined_Post => Is_Initialized'Result = Initialized
670 is
671 begin
672 return Initialized;
673 end Is_Initialized;
674
675 ----------------------------------------------------------------------------
676
Nico Hubercf88f3d2018-06-05 13:27:34 +0200677 pragma Warnings
678 (GNATprove, Off, """Registers.Register_State"" * is not modified*",
Nico Huberadfe11f2018-06-10 14:59:04 +0200679 Reason => "Power_Up_VGA is only effective in certain configurations.");
Nico Huber17b513e2022-09-04 13:36:02 +0200680 pragma Warnings
681 (GNATprove, Off, "no check message justified*", Reason => "see below");
Nico Huber42fb2d02017-09-01 17:01:51 +0200682 procedure Power_Up_VGA
Nico Hubercf88f3d2018-06-05 13:27:34 +0200683 with
684 Refined_Global =>
Nico Huberadfe11f2018-06-10 14:59:04 +0200685 (Input => (Cur_Configs, Config.Variable, Time.State),
Nico Hubercf88f3d2018-06-05 13:27:34 +0200686 In_Out => (Registers.Register_State),
687 Proof_In => (Initialized))
Nico Huber42fb2d02017-09-01 17:01:51 +0200688 is
689 Fake_Config : constant Pipe_Configs :=
690 (Primary =>
691 (Port => Analog,
692 Framebuffer => HW.GFX.Default_FB,
Nico Hubera02b2c62018-01-09 15:58:34 +0100693 Cursor => Default_Cursor,
Nico Huber42fb2d02017-09-01 17:01:51 +0200694 Mode => HW.GFX.Invalid_Mode),
695 others =>
696 (Port => Disabled,
697 Framebuffer => HW.GFX.Default_FB,
Nico Hubera02b2c62018-01-09 15:58:34 +0100698 Cursor => Default_Cursor,
Nico Huber42fb2d02017-09-01 17:01:51 +0200699 Mode => HW.GFX.Invalid_Mode));
700 begin
701 Power_And_Clocks.Power_Up (Cur_Configs, Fake_Config);
702 end Power_Up_VGA;
Nico Hubercf88f3d2018-06-05 13:27:34 +0200703 pragma Annotate
704 (GNATprove, Intentional, "unused global",
Nico Huberadfe11f2018-06-10 14:59:04 +0200705 "Power_Up_VGA is only effective in certain configurations.");
Nico Hubercf88f3d2018-06-05 13:27:34 +0200706 pragma Warnings (GNATprove, On, "no check message justified*");
707 pragma Warnings
708 (GNATprove, On, """Registers.Register_State"" * is not modified*");
Nico Huber42fb2d02017-09-01 17:01:51 +0200709
710 ----------------------------------------------------------------------------
711
Nico Huber5374c3a2017-07-15 21:48:06 +0200712 function FB_First_Page (FB : Framebuffer_Type) return Natural is
Nico Huber34be6542017-12-13 09:26:24 +0100713 (Natural (Phys_Offset (FB) / GTT_Page_Size));
Nico Huber5374c3a2017-07-15 21:48:06 +0200714 function FB_Pages (FB : Framebuffer_Type) return Natural is
715 (Natural (Div_Round_Up (FB_Size (FB), GTT_Page_Size)));
716 function FB_Last_Page (FB : Framebuffer_Type) return Natural is
717 (FB_First_Page (FB) + FB_Pages (FB) - 1);
718
Nico Huber34be6542017-12-13 09:26:24 +0100719 -- Check basics and that it fits in GTT. For 90 degree rotations,
720 -- the Offset should be above GTT_Rotation_Offset. The latter will
721 -- be subtracted for the aperture mapping.
Nico Huber5374c3a2017-07-15 21:48:06 +0200722 function Valid_FB (FB : Framebuffer_Type) return Boolean is
Nico Huber34be6542017-12-13 09:26:24 +0100723 (Valid_Stride (FB) and
724 FB_First_Page (FB) in GTT_Range and
Nico Huber2e87c0d2020-04-18 00:46:39 +0200725 FB_Last_Page (FB) + 128 in GTT_Range and
Nico Huber34be6542017-12-13 09:26:24 +0100726 (not Rotation_90 (FB) or
Nico Huber2e87c0d2020-04-18 00:46:39 +0200727 (FB_First_Page (FB) mod 64 = 0 and
728 FB_Last_Page (FB) + 128 + GTT_Rotation_Offset in GTT_Range and
Nico Huber34be6542017-12-13 09:26:24 +0100729 FB.Offset >= Word32 (GTT_Rotation_Offset) * GTT_Page_Size)));
Nico Huber5374c3a2017-07-15 21:48:06 +0200730
731 -- Also check that we don't overflow the GTT's 39-bit space
732 -- (always true with a 32-bit base)
733 function Valid_Phys_FB (FB : Framebuffer_Type; Phys_Base : Word32)
734 return Boolean is
735 (Valid_FB (FB) and
Nico Huber34be6542017-12-13 09:26:24 +0100736 Int64 (Phys_Base) + Int64 (Phys_Offset (FB)) + Int64 (FB_Size (FB)) <=
Nico Huber5374c3a2017-07-15 21:48:06 +0200737 Int64 (GTT_Address_Type'Last))
738 with
739 Ghost;
740
Nico Huber83693c82016-10-08 22:17:55 +0200741 procedure Write_GTT
742 (GTT_Page : GTT_Range;
743 Device_Address : GTT_Address_Type;
Nico Huber5374c3a2017-07-15 21:48:06 +0200744 Valid : Boolean)
745 is
Nico Huber83693c82016-10-08 22:17:55 +0200746 begin
747 Registers.Write_GTT (GTT_Page, Device_Address, Valid);
748 end Write_GTT;
749
Nico Huberceda17d2018-06-09 22:00:29 +0200750 procedure Read_GTT
751 (Device_Address : out GTT_Address_Type;
752 Valid : out Boolean;
753 GTT_Page : in GTT_Range)
754 is
755 begin
756 Registers.Read_GTT (Device_Address, Valid, GTT_Page);
757 end Read_GTT;
758
Nico Huber194e57e2017-07-15 21:15:46 +0200759 procedure Setup_Default_GTT (FB : Framebuffer_Type; Phys_Base : Word32)
Nico Huber5374c3a2017-07-15 21:48:06 +0200760 with
761 Pre => Is_Initialized and Valid_Phys_FB (FB, Phys_Base)
Nico Huber83693c82016-10-08 22:17:55 +0200762 is
Nico Huber194e57e2017-07-15 21:15:46 +0200763 Phys_Addr : GTT_Address_Type :=
Nico Huber34be6542017-12-13 09:26:24 +0100764 GTT_Address_Type (Phys_Base) + GTT_Address_Type (Phys_Offset (FB));
Nico Huber83693c82016-10-08 22:17:55 +0200765 begin
Nico Huber194e57e2017-07-15 21:15:46 +0200766 for Idx in FB_First_Page (FB) .. FB_Last_Page (FB) loop
Nico Huber83693c82016-10-08 22:17:55 +0200767 Registers.Write_GTT
768 (GTT_Page => Idx,
769 Device_Address => Phys_Addr,
770 Valid => True);
Nico Huber194e57e2017-07-15 21:15:46 +0200771 Phys_Addr := Phys_Addr + GTT_Page_Size;
Nico Huber83693c82016-10-08 22:17:55 +0200772 end loop;
Nico Huber2e87c0d2020-04-18 00:46:39 +0200773 -- Add another 128 dummy pages to work around buggy VT-d
774 for Idx in FB_Last_Page (FB) + 1 .. FB_Last_Page (FB) + 128 loop
775 Registers.Write_GTT (Idx, Phys_Addr, True);
776 end loop;
Nico Huber9b479412017-08-27 11:55:56 +0200777
778 if Rotation_90 (FB) and FB.Tiling = Y_Tiled and FB.V_Stride >= 32 then
779 declare
780 V_Pages : constant Natural := Natural (FB.V_Stride) / 32;
781 Bytes_Per_Row : constant GTT_Address_Type :=
782 GTT_Address_Type (Pixel_To_Bytes (32 * FB.Stride, FB));
783 begin
784 Phys_Addr := GTT_Address_Type (Phys_Base) +
Nico Huber34be6542017-12-13 09:26:24 +0100785 GTT_Address_Type (Phys_Offset (FB)) +
Nico Huber9b479412017-08-27 11:55:56 +0200786 GTT_Address_Type (FB_Size (FB));
787 for Page in FB_First_Page (FB) .. FB_Last_Page (FB) loop
788 Phys_Addr := Phys_Addr - Bytes_Per_Row;
789 Registers.Write_GTT
790 (GTT_Page => GTT_Rotation_Offset + Page,
791 Device_Address => Phys_Addr,
792 Valid => True);
793
794 if (Page - FB_First_Page (FB) + 1) mod V_Pages = 0 then
795 Phys_Addr := Phys_Addr + GTT_Page_Size +
796 GTT_Address_Type (V_Pages) * Bytes_Per_Row;
797 end if;
798 end loop;
799 end;
Nico Huber2e87c0d2020-04-18 00:46:39 +0200800 -- Add another 128 dummy pages to work around buggy VT-d
801 for Idx in FB_Last_Page (FB) + 1 .. FB_Last_Page (FB) + 128 loop
802 Registers.Write_GTT (GTT_Rotation_Offset + Idx, Phys_Addr, True);
803 end loop;
Nico Huber9b479412017-08-27 11:55:56 +0200804 end if;
Nico Huber83693c82016-10-08 22:17:55 +0200805 end Setup_Default_GTT;
806
807 ----------------------------------------------------------------------------
808
Nico Hubereedde882017-07-16 02:54:39 +0200809 use type HW.Word16;
810 subtype Stolen_Size_Range is Int64 range 0 .. 2 ** 33;
811
812 function GGMS_Gen4 (GGC : Word16) return Natural is
813 (Natural (Shift_Right (GGC, 8) and 16#07#));
814 function GTT_Size_Gen4 (GGC : Word16) return Natural is
815 (if GGMS_Gen4 (GGC) in 1 .. 3 then
816 (GGMS_Gen4 (GGC) + 1) * 2 ** 19 else 0);
817
818 function GMS_Gen4 (GGC : Word16) return Natural is
819 (Natural (Shift_Right (GGC, 4) and 16#0f#));
820 Valid_Stolen_Size_Gen4 : constant
821 array (Natural range 1 .. 13) of Stolen_Size_Range :=
822 (1, 4, 8, 16, 32, 48, 64, 128, 256, 96, 160, 224, 352);
823 function Stolen_Size_Gen4 (GGC : Word16) return Stolen_Size_Range is
824 (if GMS_Gen4 (GGC) in Valid_Stolen_Size_Gen4'Range then
Arthur Heymans5fd9a312017-09-12 12:45:18 +0200825 Valid_Stolen_Size_Gen4 (GMS_Gen4 (GGC)) * 2 ** 20 else 0);
Nico Hubereedde882017-07-16 02:54:39 +0200826
827 function GTT_Size_Gen6 (GGC : Word16) return Natural is
828 (Natural (Shift_Right (GGC, 8) and 16#03#) * 2 ** 20);
829
830 function Stolen_Size_Gen6 (GGC : Word16) return Stolen_Size_Range is
831 (Stolen_Size_Range (Shift_Right (GGC, 3) and 16#1f#) * 32 * 2 ** 20);
832
Nico Huberfe7985f2019-10-12 22:19:24 +0200833 function GGMS_Gen8 (GGC : Word16) return Natural is
834 (Natural (Shift_Right (GGC, 6) and 16#03#));
Nico Hubereedde882017-07-16 02:54:39 +0200835 function GTT_Size_Gen8 (GGC : Word16) return Natural is
Nico Huberfe7985f2019-10-12 22:19:24 +0200836 (if GGMS_Gen8 (GGC) /= 0 then
837 Natural (Shift_Left (Word32'(1), 20 + GGMS_Gen8 (GGC))) else 0);
Nico Hubereedde882017-07-16 02:54:39 +0200838
839 function GMS_Gen8 (GGC : Word16) return Stolen_Size_Range is
840 (Stolen_Size_Range (Shift_Right (GGC, 8) and 16#ff#));
841 function Stolen_Size_Gen8 (GGC : Word16) return Stolen_Size_Range is
842 (GMS_Gen8 (GGC) * 32 * 2 ** 20);
843
844 function Stolen_Size_Gen9 (GGC : Word16) return Stolen_Size_Range is
845 (if GMS_Gen8 (GGC) < 16#f0# then
846 Stolen_Size_Gen8 (GGC)
847 else
848 (GMS_Gen8 (GGC) - 16#f0# + 1) * 4 * 2 ** 20);
849
850 procedure Decode_Stolen
851 (GTT_Size : out Natural;
852 Stolen_Size : out Stolen_Size_Range)
853 with
854 Pre => Is_Initialized
855 is
Nico Huber63ec8362018-06-09 17:42:19 +0200856 GGC_Reg : constant PCI.Index :=
Arthur Heymans960e2392026-03-03 19:45:24 +0100857 (if Config.Gen_I945 or Config.Gen_G45 or Config.CPU_Ironlake
858 then 16#52# else 16#50#);
Nico Hubereedde882017-07-16 02:54:39 +0200859 GGC : Word16;
860 begin
861 Dev.Read16 (GGC, GGC_Reg);
Arthur Heymans960e2392026-03-03 19:45:24 +0100862 if Config.Gen_I945 then
863 -- i945 GTT is on a separate BAR3; GGC GGMS encoding differs
864 -- from Gen4+. Match the Linux driver and use the BAR size.
865 Dev.Resource_Size (GTT_Size, PCI.Res3);
866 Stolen_Size := Stolen_Size_Gen4 (GGC);
867 elsif Config.Gen_G45 or Config.CPU_Ironlake then
Nico Huber998ee2b2018-06-12 23:02:17 +0200868 GTT_Size := GTT_Size_Gen4 (GGC);
869 Stolen_Size := Stolen_Size_Gen4 (GGC);
870 elsif Config.CPU_Sandybridge or Config.CPU_Ivybridge or Config.CPU_Haswell
871 then
872 GTT_Size := GTT_Size_Gen6 (GGC);
873 Stolen_Size := Stolen_Size_Gen6 (GGC);
874 elsif Config.CPU_Broadwell then
875 GTT_Size := GTT_Size_Gen8 (GGC);
876 Stolen_Size := Stolen_Size_Gen8 (GGC);
877 else
878 GTT_Size := GTT_Size_Gen8 (GGC);
879 Stolen_Size := Stolen_Size_Gen9 (GGC);
880 end if;
Nico Hubereedde882017-07-16 02:54:39 +0200881 end Decode_Stolen;
882
Arthur Heymans960e2392026-03-03 19:45:24 +0100883 procedure GTT_Entry_Count (Count : out Natural)
884 is
885 GTT_Size : Natural;
886
887 procedure Fake_Config_State_Access
888 with
889 Global => (Input => Config.Variable),
890 Annotate => (GNATprove, Intentional, "unused global",
891 "Used to have a common contract across platforms.");
892 procedure Fake_Config_State_Access is null;
893 begin
894 Fake_Config_State_Access;
895
896 if Config.Has_I945_GTT_BAR then
897 -- i945 GTT is on a separate BAR3; its size is the BAR size.
898 Dev.Resource_Size (GTT_Size, PCI.Res3);
899 else
900 -- Gen4+: GTT size is encoded in the GGC register.
901 declare
902 GGC_Reg : constant PCI.Index :=
903 (if Config.Gen_G45 or Config.CPU_Ironlake
904 then 16#52# else 16#50#);
905 GGC : Word16;
906 begin
907 Dev.Read16 (GGC, GGC_Reg);
908 if Config.Gen_G45 or Config.CPU_Ironlake then
909 GTT_Size := GTT_Size_Gen4 (GGC);
910 elsif Config.CPU_Sandybridge or
911 Config.CPU_Ivybridge or
912 Config.CPU_Haswell
913 then
914 GTT_Size := GTT_Size_Gen6 (GGC);
915 else
916 GTT_Size := GTT_Size_Gen8 (GGC);
917 end if;
918 end;
919 end if;
920 Count := Natural'Min (GTT_Size / Config.GTT_PTE_Size, GTT_Range'Last + 1);
921 end GTT_Entry_Count;
922
Nico Hubereedde882017-07-16 02:54:39 +0200923 -- Additional runtime validation that FB fits stolen memory and aperture.
924 procedure Validate_FB (FB : Framebuffer_Type; Valid : out Boolean)
925 with
926 Pre => Is_Initialized,
927 Post => (if Valid then Valid_FB (FB))
928 is
Nico Huber2e87c0d2020-04-18 00:46:39 +0200929 GTT_Off : constant Natural :=
930 (if Rotation_90 (FB) then GTT_Rotation_Offset else 0);
931
Nico Hubereedde882017-07-16 02:54:39 +0200932 GTT_Size, Aperture_Size : Natural;
933 Stolen_Size : Stolen_Size_Range;
934 begin
935 Valid := Valid_FB (FB);
936
937 if Valid then
938 Decode_Stolen (GTT_Size, Stolen_Size);
939 Dev.Resource_Size (Aperture_Size, PCI.Res2);
940 Valid :=
Nico Huber2e87c0d2020-04-18 00:46:39 +0200941 FB_Last_Page (FB) + 128 + GTT_Off < GTT_Size / Config.GTT_PTE_Size
942 and
943 FB_Last_Page (FB) < Natural (Stolen_Size / GTT_Page_Size)
944 and
Nico Hubereedde882017-07-16 02:54:39 +0200945 FB_Last_Page (FB) < Aperture_Size / GTT_Page_Size;
Nico Huber34be6542017-12-13 09:26:24 +0100946 pragma Debug (not Valid, Debug.Put_Line
Nico Hubereedde882017-07-16 02:54:39 +0200947 ("Stolen memory too small to hold framebuffer."));
948 end if;
949 end Validate_FB;
950
Nico Huber5374c3a2017-07-15 21:48:06 +0200951 procedure Setup_Default_FB
952 (FB : in Framebuffer_Type;
953 Clear : in Boolean := True;
954 Success : out Boolean)
955 is
Nico Huber5374c3a2017-07-15 21:48:06 +0200956 GMA_Phys_Base_Mask : constant := 16#fff0_0000#;
957
958 Phys_Base : Word32;
959 begin
Nico Hubereedde882017-07-16 02:54:39 +0200960 Validate_FB (FB, Success);
Nico Huber5374c3a2017-07-15 21:48:06 +0200961
962 if Success then
Tim Wawrzynczak1b65b842022-09-09 10:23:06 -0600963 if Config.GMA_Base_Is_64bit then
964 Dev.Read32 (Phys_Base, Config.GMA_Phys_Base_Index + 4);
965 if Phys_Base /= 0 then
966 pragma Debug (Debug.Put_Line ("Cannot handle 64-bit DSM yet."));
967 Success := False;
968 return;
969 end if;
970 end if;
971
972 Dev.Read32 (Phys_Base, Config.GMA_Phys_Base_Index);
Nico Huber5374c3a2017-07-15 21:48:06 +0200973 Phys_Base := Phys_Base and GMA_Phys_Base_Mask;
974 Success := Phys_Base /= GMA_Phys_Base_Mask and Phys_Base /= 0;
975 pragma Debug (not Success, Debug.Put_Line
976 ("Failed to read stolen memory base."));
Nico Huber0164b022017-08-24 15:12:51 +0200977
978 if Success then
979 if FB.Tiling in XY_Tiling then
980 Registers.Add_Fence
981 (First_Page => FB_First_Page (FB),
982 Last_Page => FB_Last_Page (FB),
983 Tiling => FB.Tiling,
984 Pitch => FB_Pitch (FB.Stride, FB),
985 Success => Success);
986 end if;
987 pragma Debug (not Success, Debug.Put_Line
988 ("Tiled framebuffer but no fence regs available."));
989 end if;
990
Nico Huber5374c3a2017-07-15 21:48:06 +0200991 if Success then
992 Setup_Default_GTT (FB, Phys_Base);
993 end if;
994 end if;
995
996 if Success and then Clear then
997 declare
998 use type HW.Word64;
999 Linear_FB : Word64;
1000 begin
Nico Huberc3f66f62017-07-16 21:39:54 +02001001 Map_Linear_FB (Linear_FB, FB);
Nico Huber5374c3a2017-07-15 21:48:06 +02001002 if Linear_FB /= 0 then
Nico Huberc3f66f62017-07-16 21:39:54 +02001003 Framebuffer_Filler.Fill (Linear_FB, FB);
Nico Huber5374c3a2017-07-15 21:48:06 +02001004 end if;
Nico Huber5374c3a2017-07-15 21:48:06 +02001005 end;
1006 end if;
1007 end Setup_Default_FB;
1008
Nico Huberc3f66f62017-07-16 21:39:54 +02001009 procedure Map_Linear_FB (Linear_FB : out Word64; FB : in Framebuffer_Type)
1010 is
1011 use type HW.Word64;
1012
1013 Valid : Boolean;
1014 begin
1015 Linear_FB := 0;
1016
1017 if Linear_FB_Base = 0 then
1018 Dev.Map (Linear_FB_Base, PCI.Res2);
1019 pragma Debug
1020 (Linear_FB_Base = 0, Debug.Put_Line ("Failed to map resource2."));
1021 end if;
1022
1023 if Linear_FB_Base /= 0 then
1024 Validate_FB (FB, Valid);
1025 if Valid then
Nico Huber34be6542017-12-13 09:26:24 +01001026 Linear_FB := Linear_FB_Base + Word64 (Phys_Offset (FB));
Nico Huberc3f66f62017-07-16 21:39:54 +02001027 end if;
1028 end if;
1029 end Map_Linear_FB;
1030
Nico Huber5374c3a2017-07-15 21:48:06 +02001031 ----------------------------------------------------------------------------
1032
Nico Huber99f10f32016-11-20 00:34:05 +01001033 procedure Dump_Configs (Configs : Pipe_Configs)
Nico Huber83693c82016-10-08 22:17:55 +02001034 is
1035 subtype Pipe_Name is String (1 .. 9);
Nico Huber99f10f32016-11-20 00:34:05 +01001036 type Pipe_Name_Array is array (Pipe_Index) of Pipe_Name;
Nico Huber83693c82016-10-08 22:17:55 +02001037 Pipe_Names : constant Pipe_Name_Array :=
1038 (Primary => "Primary ",
1039 Secondary => "Secondary",
1040 Tertiary => "Tertiary ");
Nico Huber5ef4d602017-12-13 13:56:47 +01001041
1042 subtype Tiling_Name is String (1 .. 7);
1043 type Tiling_Name_Array is array (Tiling_Type) of Tiling_Name;
1044 Tilings : constant Tiling_Name_Array :=
1045 (Linear => "Linear ",
1046 X_Tiled => "X_Tiled",
1047 Y_Tiled => "Y_Tiled");
1048
1049 subtype Rotation_Name is String (1 .. 11);
1050 type Rotation_Name_Array is array (Rotation_Type) of Rotation_Name;
1051 Rotations : constant Rotation_Name_Array :=
1052 (No_Rotation => "No_Rotation",
1053 Rotated_90 => "Rotated_90 ",
1054 Rotated_180 => "Rotated_180",
1055 Rotated_270 => "Rotated_270");
Nico Huber83693c82016-10-08 22:17:55 +02001056 begin
1057 Debug.New_Line;
Paul Menzelb83107c2017-05-04 09:02:33 +02001058 Debug.Put_Line ("CONFIG =>");
Nico Huber99f10f32016-11-20 00:34:05 +01001059 for Pipe in Pipe_Index loop
1060 if Pipe = Pipe_Index'First then
Nico Huber83693c82016-10-08 22:17:55 +02001061 Debug.Put (" (");
1062 else
1063 Debug.Put (" ");
1064 end if;
1065 Debug.Put_Line (Pipe_Names (Pipe) & " =>");
1066 Debug.Put_Line
1067 (" (Port => " & Port_Names (Configs (Pipe).Port) & ",");
1068 Debug.Put_Line (" Framebuffer =>");
Nico Huber5ef4d602017-12-13 13:56:47 +01001069 Debug.Put (" (Width => ");
Nico Huber83693c82016-10-08 22:17:55 +02001070 Debug.Put_Int32 (Configs (Pipe).Framebuffer.Width);
1071 Debug.Put_Line (",");
Nico Huber5ef4d602017-12-13 13:56:47 +01001072 Debug.Put (" Height => ");
Nico Huber83693c82016-10-08 22:17:55 +02001073 Debug.Put_Int32 (Configs (Pipe).Framebuffer.Height);
1074 Debug.Put_Line (",");
Nico Huber5ef4d602017-12-13 13:56:47 +01001075 Debug.Put (" Start_X => ");
1076 Debug.Put_Int32 (Configs (Pipe).Framebuffer.Start_X);
1077 Debug.Put_Line (",");
1078 Debug.Put (" Start_Y => ");
1079 Debug.Put_Int32 (Configs (Pipe).Framebuffer.Start_Y);
1080 Debug.Put_Line (",");
1081 Debug.Put (" Stride => ");
Nico Huber83693c82016-10-08 22:17:55 +02001082 Debug.Put_Int32 (Configs (Pipe).Framebuffer.Stride);
1083 Debug.Put_Line (",");
Nico Huber5ef4d602017-12-13 13:56:47 +01001084 Debug.Put (" V_Stride => ");
1085 Debug.Put_Int32 (Configs (Pipe).Framebuffer.V_Stride);
1086 Debug.Put_Line (",");
1087 Debug.Put (" Tiling => ");
1088 Debug.Put_Line (Tilings (Configs (Pipe).Framebuffer.Tiling) & ",");
1089 Debug.Put (" Rotation => ");
1090 Debug.Put_Line (Rotations (Configs (Pipe).Framebuffer.Rotation) & ",");
Nico Huber83693c82016-10-08 22:17:55 +02001091 Debug.Put (" Offset => ");
1092 Debug.Put_Word32 (Configs (Pipe).Framebuffer.Offset);
1093 Debug.Put_Line (",");
1094 Debug.Put (" BPC => ");
1095 Debug.Put_Int64 (Configs (Pipe).Framebuffer.BPC);
1096 Debug.Put_Line ("),");
1097 Debug.Put_Line (" Mode =>");
1098 Debug.Put (" (Dotclock => ");
1099 Debug.Put_Int64 (Configs (Pipe).Mode.Dotclock);
1100 Debug.Put_Line (",");
1101 Debug.Put (" H_Visible => ");
Nico Huberc5c767a2018-06-03 01:09:04 +02001102 Debug.Put_Int32 (Configs (Pipe).Mode.H_Visible);
Nico Huber83693c82016-10-08 22:17:55 +02001103 Debug.Put_Line (",");
1104 Debug.Put (" H_Sync_Begin => ");
Nico Huberc5c767a2018-06-03 01:09:04 +02001105 Debug.Put_Int32 (Configs (Pipe).Mode.H_Sync_Begin);
Nico Huber83693c82016-10-08 22:17:55 +02001106 Debug.Put_Line (",");
1107 Debug.Put (" H_Sync_End => ");
Nico Huberc5c767a2018-06-03 01:09:04 +02001108 Debug.Put_Int32 (Configs (Pipe).Mode.H_Sync_End);
Nico Huber83693c82016-10-08 22:17:55 +02001109 Debug.Put_Line (",");
1110 Debug.Put (" H_Total => ");
Nico Huberc5c767a2018-06-03 01:09:04 +02001111 Debug.Put_Int32 (Configs (Pipe).Mode.H_Total);
Nico Huber83693c82016-10-08 22:17:55 +02001112 Debug.Put_Line (",");
1113 Debug.Put (" V_Visible => ");
Nico Huberc5c767a2018-06-03 01:09:04 +02001114 Debug.Put_Int32 (Configs (Pipe).Mode.V_Visible);
Nico Huber83693c82016-10-08 22:17:55 +02001115 Debug.Put_Line (",");
1116 Debug.Put (" V_Sync_Begin => ");
Nico Huberc5c767a2018-06-03 01:09:04 +02001117 Debug.Put_Int32 (Configs (Pipe).Mode.V_Sync_Begin);
Nico Huber83693c82016-10-08 22:17:55 +02001118 Debug.Put_Line (",");
1119 Debug.Put (" V_Sync_End => ");
Nico Huberc5c767a2018-06-03 01:09:04 +02001120 Debug.Put_Int32 (Configs (Pipe).Mode.V_Sync_End);
Nico Huber83693c82016-10-08 22:17:55 +02001121 Debug.Put_Line (",");
1122 Debug.Put (" V_Total => ");
Nico Huberc5c767a2018-06-03 01:09:04 +02001123 Debug.Put_Int32 (Configs (Pipe).Mode.V_Total);
Nico Huber83693c82016-10-08 22:17:55 +02001124 Debug.Put_Line (",");
1125 Debug.Put_Line (" H_Sync_Active_High => " &
1126 (if Configs (Pipe).Mode.H_Sync_Active_High
1127 then "True,"
1128 else "False,"));
1129 Debug.Put_Line (" V_Sync_Active_High => " &
1130 (if Configs (Pipe).Mode.V_Sync_Active_High
1131 then "True,"
1132 else "False,"));
1133 Debug.Put (" BPC => ");
1134 Debug.Put_Int64 (Configs (Pipe).Mode.BPC);
Nico Huber99f10f32016-11-20 00:34:05 +01001135 if Pipe /= Pipe_Index'Last then
Nico Huber83693c82016-10-08 22:17:55 +02001136 Debug.Put_Line (")),");
1137 else
1138 Debug.Put_Line (")));");
1139 end if;
1140 end loop;
1141 end Dump_Configs;
1142
Nico Huberc5c66ec2019-09-28 23:59:45 +02001143 ----------------------------------------------------------------------------
1144
1145 procedure PCI_Read16 (Value : out Word16; Offset : HW.PCI.Index) is
1146 begin
1147 Dev.Read16 (Value, Offset);
1148 end PCI_Read16;
1149
Nico Huber83693c82016-10-08 22:17:55 +02001150end HW.GFX.GMA;