blob: 1ba4ee0cee1fcd13e9f1e2b44571c6f815a00649 [file] [log] [blame]
Nico Huber83693c82016-10-08 22:17:55 +02001--
Nico Huberfdb0df12018-02-07 14:30:34 +01002-- Copyright (C) 2015-2018 secunet Security Networks AG
Nico Huber83693c82016-10-08 22:17:55 +02003--
4-- This program is free software; you can redistribute it and/or modify
5-- it under the terms of the GNU General Public License as published by
Nico Huber125a29e2016-10-18 00:23:54 +02006-- the Free Software Foundation; either version 2 of the License, or
7-- (at your option) any later version.
Nico Huber83693c82016-10-08 22:17:55 +02008--
9-- This program is distributed in the hope that it will be useful,
10-- but WITHOUT ANY WARRANTY; without even the implied warranty of
11-- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12-- GNU General Public License for more details.
13--
14
15with HW.Debug;
16with GNAT.Source_Info;
17
18with HW.GFX.GMA.Config;
Nico Huber7ad2d652016-12-07 15:19:32 +010019with HW.GFX.GMA.Transcoder;
Nico Huber83693c82016-10-08 22:17:55 +020020
21package body HW.GFX.GMA.Pipe_Setup is
22
Nico Huberfbb42202016-11-07 15:08:26 +010023 ILK_DISPLAY_CHICKEN1_VGA_MASK : constant := 7 * 2 ** 29;
24 ILK_DISPLAY_CHICKEN1_VGA_ENABLE : constant := 5 * 2 ** 29;
25 ILK_DISPLAY_CHICKEN2_VGA_MASK : constant := 1 * 2 ** 25;
26 ILK_DISPLAY_CHICKEN2_VGA_ENABLE : constant := 0 * 2 ** 25;
27
Nico Huber7ad2d652016-12-07 15:19:32 +010028 DSPCNTR_ENABLE : constant := 1 * 2 ** 31;
29 DSPCNTR_GAMMA_CORRECTION : constant := 1 * 2 ** 30;
30 DSPCNTR_DISABLE_TRICKLE_FEED : constant := 1 * 2 ** 14;
31 DSPCNTR_FORMAT_MASK : constant := 15 * 2 ** 26;
Nico Huber83693c82016-10-08 22:17:55 +020032
33 DSPCNTR_MASK : constant Word32 :=
34 DSPCNTR_ENABLE or
35 DSPCNTR_GAMMA_CORRECTION or
36 DSPCNTR_FORMAT_MASK or
37 DSPCNTR_DISABLE_TRICKLE_FEED;
38
39 PLANE_CTL_PLANE_ENABLE : constant := 1 * 2 ** 31;
40 PLANE_CTL_SRC_PIX_FMT_RGB_32B_8888 : constant := 4 * 2 ** 24;
41 PLANE_CTL_PLANE_GAMMA_DISABLE : constant := 1 * 2 ** 13;
Nico Huber0164b022017-08-24 15:12:51 +020042 PLANE_CTL_TILED_SURFACE_MASK : constant := 7 * 2 ** 10;
43 PLANE_CTL_TILED_SURFACE_LINEAR : constant := 0 * 2 ** 10;
44 PLANE_CTL_TILED_SURFACE_X_TILED : constant := 1 * 2 ** 10;
45 PLANE_CTL_TILED_SURFACE_Y_TILED : constant := 4 * 2 ** 10;
46 PLANE_CTL_TILED_SURFACE_YF_TILED : constant := 5 * 2 ** 10;
47
48 PLANE_CTL_TILED_SURFACE : constant array (Tiling_Type) of Word32 :=
49 (Linear => PLANE_CTL_TILED_SURFACE_LINEAR,
50 X_Tiled => PLANE_CTL_TILED_SURFACE_X_TILED,
51 Y_Tiled => PLANE_CTL_TILED_SURFACE_Y_TILED);
Nico Huber83693c82016-10-08 22:17:55 +020052
Nico Huber9b479412017-08-27 11:55:56 +020053 PLANE_CTL_PLANE_ROTATION_MASK : constant := 3 * 2 ** 0;
54 PLANE_CTL_PLANE_ROTATION : constant array (Rotation_Type) of Word32 :=
55 (No_Rotation => 0 * 2 ** 0,
56 Rotated_90 => 1 * 2 ** 0,
57 Rotated_180 => 2 * 2 ** 0,
58 Rotated_270 => 3 * 2 ** 0);
59
Nico Huber83693c82016-10-08 22:17:55 +020060 PLANE_WM_ENABLE : constant := 1 * 2 ** 31;
61 PLANE_WM_LINES_SHIFT : constant := 14;
62 PLANE_WM_LINES_MASK : constant := 16#001f# * 2 ** 14;
63 PLANE_WM_BLOCKS_MASK : constant := 16#03ff# * 2 ** 0;
64
Nico Huber33912aa2016-12-06 20:36:23 +010065 VGA_SR_INDEX : constant := 16#03c4#;
66 VGA_SR_DATA : constant := 16#03c5#;
67 VGA_SR01 : constant := 16#01#;
68 VGA_SR01_SCREEN_OFF : constant := 1 * 2 ** 5;
Nico Huber3675db52016-11-04 16:27:29 +010069
70 VGA_CONTROL_VGA_DISPLAY_DISABLE : constant := 1 * 2 ** 31;
71 VGA_CONTROL_BLINK_DUTY_CYCLE_MASK : constant := 16#0003# * 2 ** 6;
72 VGA_CONTROL_BLINK_DUTY_CYCLE_50 : constant := 2 * 2 ** 6;
73 VGA_CONTROL_VSYNC_BLINK_RATE_MASK : constant := 16#003f# * 2 ** 0;
74
75 subtype VGA_Cycle_Count is Pos32 range 2 .. 128;
76 function VGA_CONTROL_VSYNC_BLINK_RATE
77 (Cycles : VGA_Cycle_Count)
78 return Word32
79 is
80 begin
81 return Word32 (Cycles) / 2 - 1;
82 end VGA_CONTROL_VSYNC_BLINK_RATE;
83
Nico Huber7ad2d652016-12-07 15:19:32 +010084 PF_CTRL_ENABLE : constant := 1 * 2 ** 31;
85 PF_CTRL_PIPE_SELECT_MASK : constant := 3 * 2 ** 29;
86 PF_CTRL_FILTER_MED : constant := 1 * 2 ** 23;
Nico Huber83693c82016-10-08 22:17:55 +020087
Nico Huber7ad2d652016-12-07 15:19:32 +010088 PS_CTRL_ENABLE_SCALER : constant := 1 * 2 ** 31;
89 PS_CTRL_SCALER_MODE_7X5_EXTENDED : constant := 1 * 2 ** 28;
90 PS_CTRL_FILTER_SELECT_MEDIUM_2 : constant := 1 * 2 ** 23;
Nico Huber83693c82016-10-08 22:17:55 +020091
Arthur Heymansdfcdd772018-03-28 16:42:50 +020092 VGACNTRL_REG : constant Registers.Registers_Index :=
93 (if Config.Has_GMCH_VGACNTRL then
94 Registers.GMCH_VGACNTRL
95 else Registers.CPU_VGACNTRL);
96
Nico Huber83693c82016-10-08 22:17:55 +020097 ---------------------------------------------------------------------------
98
Nico Huber83693c82016-10-08 22:17:55 +020099 function PLANE_WM_LINES (Lines : Natural) return Word32 is
100 begin
101 return Shift_Left (Word32 (Lines), PLANE_WM_LINES_SHIFT)
102 and PLANE_WM_LINES_MASK;
103 end PLANE_WM_LINES;
104
105 function PLANE_WM_BLOCKS (Blocks : Natural) return Word32 is
106 begin
107 return Word32 (Blocks) and PLANE_WM_BLOCKS_MASK;
108 end PLANE_WM_BLOCKS;
109
110 ---------------------------------------------------------------------------
111
112 function Encode (LSW, MSW : Pos16) return Word32 is
113 begin
Nico Huber7ad2d652016-12-07 15:19:32 +0100114 return Shift_Left (Word32 (MSW) - 1, 16) or (Word32 (LSW) - 1);
Nico Huber83693c82016-10-08 22:17:55 +0200115 end Encode;
116
117 ----------------------------------------------------------------------------
118
Nico Huber83693c82016-10-08 22:17:55 +0200119 procedure Clear_Watermarks (Controller : Controller_Type) is
120 begin
121 Registers.Write
122 (Register => Controller.PLANE_BUF_CFG,
123 Value => 16#0000_0000#);
124 for Level in WM_Levels range 0 .. WM_Levels'Last loop
125 Registers.Write
126 (Register => Controller.PLANE_WM (Level),
127 Value => 16#0000_0000#);
128 end loop;
129 Registers.Write
130 (Register => Controller.WM_LINETIME,
131 Value => 16#0000_0000#);
132 end Clear_Watermarks;
133
134 procedure Setup_Watermarks (Controller : Controller_Type)
135 is
Nico Huberf3e23662016-12-05 21:33:03 +0100136 type Per_Plane_Buffer_Range is array (Pipe_Index) of Word32;
137 Buffer_Range : constant Per_Plane_Buffer_Range :=
138 (Primary => Shift_Left (159, 16) or 0,
139 Secondary => Shift_Left (319, 16) or 160,
140 Tertiary => Shift_Left (479, 16) or 320);
Nico Huber83693c82016-10-08 22:17:55 +0200141 begin
142 Registers.Write
143 (Register => Controller.PLANE_BUF_CFG,
Nico Huberf3e23662016-12-05 21:33:03 +0100144 Value => Buffer_Range (Controller.Pipe));
Nico Huber83693c82016-10-08 22:17:55 +0200145 Registers.Write
146 (Register => Controller.PLANE_WM (0),
147 Value => PLANE_WM_ENABLE or
148 PLANE_WM_LINES (2) or
149 PLANE_WM_BLOCKS (160));
150 end Setup_Watermarks;
151
152 ----------------------------------------------------------------------------
153
Nico Huber3675db52016-11-04 16:27:29 +0100154 procedure Setup_Hires_Plane
Nico Huber6a4dfc82016-11-04 15:50:58 +0100155 (Controller : Controller_Type;
Nico Huber0164b022017-08-24 15:12:51 +0200156 FB : HW.GFX.Framebuffer_Type)
Nico Huber83693c82016-10-08 22:17:55 +0200157 with
158 Global => (In_Out => Registers.Register_State),
159 Depends =>
160 (Registers.Register_State
161 =>+
162 (Registers.Register_State,
163 Controller,
Nico Huber9b479412017-08-27 11:55:56 +0200164 FB)),
Nico Huber5ef4d602017-12-13 13:56:47 +0100165 Pre => FB.Height + FB.Start_Y <= FB.V_Stride
Nico Huber83693c82016-10-08 22:17:55 +0200166 is
167 -- FIXME: setup correct format, based on framebuffer RGB format
168 Format : constant Word32 := 6 * 2 ** 26;
169 PRI : Word32 := DSPCNTR_ENABLE or Format;
Nico Huber83693c82016-10-08 22:17:55 +0200170 begin
171 pragma Debug (Debug.Put_Line (GNAT.Source_Info.Enclosing_Entity));
172
Nico Huber83693c82016-10-08 22:17:55 +0200173 if Config.Has_Plane_Control then
Nico Huber9b479412017-08-27 11:55:56 +0200174 declare
Nico Huber34be6542017-12-13 09:26:24 +0100175 Stride, Offset : Word32;
Nico Huber9b479412017-08-27 11:55:56 +0200176 Width : constant Pos16 := Rotated_Width (FB);
177 Height : constant Pos16 := Rotated_Height (FB);
178 begin
179 if Rotation_90 (FB) then
Nico Huber5ef4d602017-12-13 13:56:47 +0100180 Stride := Word32 (FB_Pitch (FB.V_Stride, FB));
181 Offset := Shift_Left (Word32 (FB.Start_X), 16) or
182 Word32 (FB.V_Stride - FB.Height - FB.Start_Y);
Nico Huber9b479412017-08-27 11:55:56 +0200183 else
Nico Huber5ef4d602017-12-13 13:56:47 +0100184 Stride := Word32 (FB_Pitch (FB.Stride, FB));
185 Offset := Shift_Left (Word32 (FB.Start_Y), 16) or
186 Word32 (FB.Start_X);
Nico Huber9b479412017-08-27 11:55:56 +0200187 end if;
188 Registers.Write
189 (Register => Controller.PLANE_CTL,
190 Value => PLANE_CTL_PLANE_ENABLE or
191 PLANE_CTL_SRC_PIX_FMT_RGB_32B_8888 or
192 PLANE_CTL_PLANE_GAMMA_DISABLE or
193 PLANE_CTL_TILED_SURFACE (FB.Tiling) or
194 PLANE_CTL_PLANE_ROTATION (FB.Rotation));
195 Registers.Write (Controller.PLANE_OFFSET, Offset);
196 Registers.Write (Controller.PLANE_SIZE, Encode (Width, Height));
197 Registers.Write (Controller.PLANE_STRIDE, Stride);
198 Registers.Write (Controller.PLANE_POS, 16#0000_0000#);
Nico Huber34be6542017-12-13 09:26:24 +0100199 Registers.Write (Controller.PLANE_SURF, FB.Offset and 16#ffff_f000#);
Nico Huber9b479412017-08-27 11:55:56 +0200200 end;
Nico Huber83693c82016-10-08 22:17:55 +0200201 else
202 if Config.Disable_Trickle_Feed then
203 PRI := PRI or DSPCNTR_DISABLE_TRICKLE_FEED;
204 end if;
205 -- for now, just disable gamma LUT (can't do anything
206 -- useful without colorimetry information from display)
207 Registers.Unset_And_Set_Mask
208 (Register => Controller.DSPCNTR,
209 Mask_Unset => DSPCNTR_MASK,
210 Mask_Set => PRI);
211
Nico Huber0164b022017-08-24 15:12:51 +0200212 Registers.Write
213 (Controller.DSPSTRIDE, Word32 (Pixel_To_Bytes (FB.Stride, FB)));
Nico Huber83693c82016-10-08 22:17:55 +0200214 if Config.Has_DSP_Linoff then
Nico Huber5ef4d602017-12-13 13:56:47 +0100215 Registers.Write
216 (Register => Controller.DSPLINOFF,
217 Value => Word32 (Pixel_To_Bytes
218 (FB.Start_Y * FB.Stride + FB.Start_X, FB)));
219 Registers.Write (Controller.DSPTILEOFF, 0);
220 else
221 Registers.Write
222 (Register => Controller.DSPTILEOFF,
223 Value => Shift_Left (Word32 (FB.Start_Y), 16) or
224 Word32 (FB.Start_X));
Nico Huber83693c82016-10-08 22:17:55 +0200225 end if;
Nico Huber8fd92a12018-01-02 14:02:59 +0100226 Registers.Write (Controller.DSPSURF, FB.Offset and 16#ffff_f000#);
Nico Huber83693c82016-10-08 22:17:55 +0200227 end if;
Nico Huber3675db52016-11-04 16:27:29 +0100228 end Setup_Hires_Plane;
229
230 procedure Setup_Display
Nico Huber113a14b2016-12-06 21:59:15 +0100231 (Controller : Controller_Type;
232 Framebuffer : Framebuffer_Type;
233 Dither_BPC : BPC_Type;
234 Dither : Boolean)
Nico Huber3675db52016-11-04 16:27:29 +0100235 with
236 Global => (In_Out => (Registers.Register_State, Port_IO.State)),
237 Depends =>
238 (Registers.Register_State
239 =>+
240 (Registers.Register_State,
241 Controller,
Nico Huber113a14b2016-12-06 21:59:15 +0100242 Framebuffer,
243 Dither_BPC,
244 Dither),
Nico Huber3675db52016-11-04 16:27:29 +0100245 Port_IO.State
246 =>+
Nico Huber9b479412017-08-27 11:55:56 +0200247 (Framebuffer)),
248 Pre =>
249 Framebuffer.Offset = VGA_PLANE_FRAMEBUFFER_OFFSET or
Nico Huber5ef4d602017-12-13 13:56:47 +0100250 Framebuffer.Height + Framebuffer.Start_Y <= Framebuffer.V_Stride
Nico Huber3675db52016-11-04 16:27:29 +0100251 is
252 use type Word8;
253
254 Reg8 : Word8;
255 begin
256 pragma Debug (Debug.Put_Line (GNAT.Source_Info.Enclosing_Entity));
257
258 if Config.Has_Plane_Control then
259 Setup_Watermarks (Controller);
260 end if;
261
262 if Framebuffer.Offset = VGA_PLANE_FRAMEBUFFER_OFFSET then
Nico Huberfbb42202016-11-07 15:08:26 +0100263 if Config.VGA_Plane_Workaround then
264 Registers.Unset_And_Set_Mask
265 (Register => Registers.ILK_DISPLAY_CHICKEN1,
266 Mask_Unset => ILK_DISPLAY_CHICKEN1_VGA_MASK,
267 Mask_Set => ILK_DISPLAY_CHICKEN1_VGA_ENABLE);
268 Registers.Unset_And_Set_Mask
269 (Register => Registers.ILK_DISPLAY_CHICKEN2,
270 Mask_Unset => ILK_DISPLAY_CHICKEN2_VGA_MASK,
271 Mask_Set => ILK_DISPLAY_CHICKEN2_VGA_ENABLE);
272 end if;
273
Nico Huber3675db52016-11-04 16:27:29 +0100274 Registers.Unset_And_Set_Mask
Arthur Heymansdfcdd772018-03-28 16:42:50 +0200275 (Register => VGACNTRL_REG,
Nico Huber3675db52016-11-04 16:27:29 +0100276 Mask_Unset => VGA_CONTROL_VGA_DISPLAY_DISABLE or
277 VGA_CONTROL_BLINK_DUTY_CYCLE_MASK or
278 VGA_CONTROL_VSYNC_BLINK_RATE_MASK,
279 Mask_Set => VGA_CONTROL_BLINK_DUTY_CYCLE_50 or
280 VGA_CONTROL_VSYNC_BLINK_RATE (30));
281
282 Port_IO.OutB (VGA_SR_INDEX, VGA_SR01);
283 Port_IO.InB (Reg8, VGA_SR_DATA);
284 Port_IO.OutB (VGA_SR_DATA, Reg8 and not (VGA_SR01_SCREEN_OFF));
285 else
Nico Huber6a4dfc82016-11-04 15:50:58 +0100286 Setup_Hires_Plane (Controller, Framebuffer);
Nico Huber3675db52016-11-04 16:27:29 +0100287 end if;
288
289 Registers.Write
290 (Register => Controller.PIPESRC,
291 Value => Encode
Nico Huber9b479412017-08-27 11:55:56 +0200292 (Rotated_Height (Framebuffer), Rotated_Width (Framebuffer)));
Nico Huber83693c82016-10-08 22:17:55 +0200293
Nico Huber113a14b2016-12-06 21:59:15 +0100294 if Config.Has_Pipeconf_Misc then
295 Registers.Write
296 (Register => Controller.PIPEMISC,
Nico Huber7ad2d652016-12-07 15:19:32 +0100297 Value => Transcoder.BPC_Conf (Dither_BPC, Dither));
Nico Huber113a14b2016-12-06 21:59:15 +0100298 end if;
Nico Huber83693c82016-10-08 22:17:55 +0200299 end Setup_Display;
300
301 ----------------------------------------------------------------------------
302
Nico Huber4916e342016-11-04 14:37:53 +0100303 procedure Scale_Keep_Aspect
304 (Width : out Pos32;
305 Height : out Pos32;
306 Max_Width : in Pos32;
307 Max_Height : in Pos32;
308 Framebuffer : in Framebuffer_Type)
309 with
310 Pre =>
311 Max_Width <= Pos32 (Pos16'Last) and
312 Max_Height <= Pos32 (Pos16'Last) and
Nico Huber9b479412017-08-27 11:55:56 +0200313 Pos32 (Rotated_Width (Framebuffer)) <= Max_Width and
314 Pos32 (Rotated_Height (Framebuffer)) <= Max_Height,
Nico Huber4916e342016-11-04 14:37:53 +0100315 Post =>
316 Width <= Max_Width and Height <= Max_Height
317 is
Nico Huber9b479412017-08-27 11:55:56 +0200318 Src_Width : constant Pos32 := Pos32 (Rotated_Width (Framebuffer));
319 Src_Height : constant Pos32 := Pos32 (Rotated_Height (Framebuffer));
Nico Huber4916e342016-11-04 14:37:53 +0100320 begin
Nico Huber9b479412017-08-27 11:55:56 +0200321 if (Max_Width * Src_Height) / Src_Width <= Max_Height then
Nico Huber4916e342016-11-04 14:37:53 +0100322 Width := Max_Width;
Nico Huber9b479412017-08-27 11:55:56 +0200323 Height := (Max_Width * Src_Height) / Src_Width;
Nico Huber4916e342016-11-04 14:37:53 +0100324 else
325 Height := Max_Height;
326 Width := Pos32'Min (Max_Width, -- could prove, it's <= Max_Width
Nico Huber9b479412017-08-27 11:55:56 +0200327 (Max_Height * Src_Width) / Src_Height);
Nico Huber4916e342016-11-04 14:37:53 +0100328 end if;
329 end Scale_Keep_Aspect;
330
331 procedure Setup_Skylake_Pipe_Scaler
332 (Controller : in Controller_Type;
333 Mode : in HW.GFX.Mode_Type;
334 Framebuffer : in HW.GFX.Framebuffer_Type)
335 with
336 Pre =>
Nico Huber9b479412017-08-27 11:55:56 +0200337 Rotated_Width (Framebuffer) <= Mode.H_Visible and
338 Rotated_Height (Framebuffer) <= Mode.V_Visible
Nico Huber4916e342016-11-04 14:37:53 +0100339 is
Nico Huber7ad2d652016-12-07 15:19:32 +0100340 use type Registers.Registers_Invalid_Index;
341
Nico Huber4916e342016-11-04 14:37:53 +0100342 -- Enable 7x5 extended mode where possible:
343 Scaler_Mode : constant Word32 :=
344 (if Controller.PS_CTRL_2 /= Registers.Invalid_Register then
345 PS_CTRL_SCALER_MODE_7X5_EXTENDED else 0);
346
Nico Huber9b479412017-08-27 11:55:56 +0200347 Width_In : constant Pos32 := Pos32 (Rotated_Width (Framebuffer));
348 Height_In : constant Pos32 := Pos32 (Rotated_Height (Framebuffer));
349
Nico Huber4916e342016-11-04 14:37:53 +0100350 -- We can scale up to 2.99x horizontally:
Nico Huber9b479412017-08-27 11:55:56 +0200351 Horizontal_Limit : constant Pos32 := (Width_In * 299) / 100;
Nico Huber4916e342016-11-04 14:37:53 +0100352 -- The third scaler is limited to 1.99x
353 -- vertical scaling for source widths > 2048:
354 Vertical_Limit : constant Pos32 :=
Nico Huber9b479412017-08-27 11:55:56 +0200355 (Height_In *
Nico Huber4916e342016-11-04 14:37:53 +0100356 (if Controller.PS_CTRL_2 = Registers.Invalid_Register and
Nico Huber9b479412017-08-27 11:55:56 +0200357 Width_In > 2048
Nico Huber4916e342016-11-04 14:37:53 +0100358 then
359 199
360 else
361 299)) / 100;
362
363 Width, Height : Pos32;
364 begin
365 -- Writes to WIN_SZ arm the PS registers.
366
367 Scale_Keep_Aspect
368 (Width => Width,
369 Height => Height,
370 Max_Width => Pos32'Min (Horizontal_Limit, Pos32 (Mode.H_Visible)),
371 Max_Height => Pos32'Min (Vertical_Limit, Pos32 (Mode.V_Visible)),
372 Framebuffer => Framebuffer);
373
374 Registers.Write
375 (Register => Controller.PS_CTRL_1,
376 Value => PS_CTRL_ENABLE_SCALER or Scaler_Mode);
377 Registers.Write
378 (Register => Controller.PS_WIN_POS_1,
379 Value =>
380 Shift_Left (Word32 (Pos32 (Mode.H_Visible) - Width) / 2, 16) or
381 Word32 (Pos32 (Mode.V_Visible) - Height) / 2);
382 Registers.Write
383 (Register => Controller.PS_WIN_SZ_1,
384 Value => Shift_Left (Word32 (Width), 16) or Word32 (Height));
385 end Setup_Skylake_Pipe_Scaler;
386
387 procedure Setup_Ironlake_Panel_Fitter
388 (Controller : in Controller_Type;
389 Mode : in HW.GFX.Mode_Type;
390 Framebuffer : in HW.GFX.Framebuffer_Type)
391 with
392 Pre =>
Nico Huber9b479412017-08-27 11:55:56 +0200393 Rotated_Width (Framebuffer) <= Mode.H_Visible and
394 Rotated_Height (Framebuffer) <= Mode.V_Visible
Nico Huber4916e342016-11-04 14:37:53 +0100395 is
396 -- Force 1:1 mapping of panel fitter:pipe
397 PF_Ctrl_Pipe_Sel : constant Word32 :=
398 (if Config.Has_PF_Pipe_Select then
399 (case Controller.PF_CTRL is
400 when Registers.PFA_CTL_1 => 0 * 2 ** 29,
401 when Registers.PFB_CTL_1 => 1 * 2 ** 29,
402 when Registers.PFC_CTL_1 => 2 * 2 ** 29,
403 when others => 0) else 0);
404
405 Width, Height : Pos32;
Nico Huberfdb0df12018-02-07 14:30:34 +0100406 X, Y : Int32;
Nico Huber4916e342016-11-04 14:37:53 +0100407 begin
408 -- Writes to WIN_SZ arm the PF registers.
409
410 Scale_Keep_Aspect
411 (Width => Width,
412 Height => Height,
413 Max_Width => Pos32 (Mode.H_Visible),
414 Max_Height => Pos32 (Mode.V_Visible),
415 Framebuffer => Framebuffer);
416
Nico Huberfdb0df12018-02-07 14:30:34 +0100417 -- Do not scale to odd width (at least Haswell has trouble with this).
418 if Width < Pos32 (Mode.H_Visible) and Width mod 2 = 1 then
419 Width := Width + 1;
420 end if;
421
422 X := (Int32 (Mode.H_Visible) - Width) / 2;
423 Y := (Int32 (Mode.V_Visible) - Height) / 2;
424
425 -- Hardware is picky about minimal horizontal gaps.
426 if Pos32 (Mode.H_Visible) - Width <= 3 then
427 Width := Pos32(Mode.H_Visible);
428 X := 0;
429 end if;
430
Nico Huber4916e342016-11-04 14:37:53 +0100431 Registers.Write
432 (Register => Controller.PF_CTRL,
433 Value => PF_CTRL_ENABLE or PF_Ctrl_Pipe_Sel or PF_CTRL_FILTER_MED);
434 Registers.Write
435 (Register => Controller.PF_WIN_POS,
Nico Huberfdb0df12018-02-07 14:30:34 +0100436 Value => Shift_Left (Word32 (X), 16) or Word32 (Y));
Nico Huber4916e342016-11-04 14:37:53 +0100437 Registers.Write
438 (Register => Controller.PF_WIN_SZ,
439 Value => Shift_Left (Word32 (Width), 16) or Word32 (Height));
440 end Setup_Ironlake_Panel_Fitter;
441
Nico Huberb4b72792018-01-02 13:45:41 +0100442 procedure Panel_Fitter_Off (Controller : Controller_Type)
443 is
444 use type HW.GFX.GMA.Registers.Registers_Invalid_Index;
445 begin
446 -- Writes to WIN_SZ arm the PS/PF registers.
447 if Config.Has_Plane_Control then
448 Registers.Unset_Mask (Controller.PS_CTRL_1, PS_CTRL_ENABLE_SCALER);
449 Registers.Write (Controller.PS_WIN_SZ_1, 16#0000_0000#);
450 if Controller.PS_CTRL_2 /= Registers.Invalid_Register and
451 Controller.PS_WIN_SZ_2 /= Registers.Invalid_Register
452 then
453 Registers.Unset_Mask (Controller.PS_CTRL_2, PS_CTRL_ENABLE_SCALER);
454 Registers.Write (Controller.PS_WIN_SZ_2, 16#0000_0000#);
455 end if;
456 else
457 Registers.Unset_Mask (Controller.PF_CTRL, PF_CTRL_ENABLE);
458 Registers.Write (Controller.PF_WIN_SZ, 16#0000_0000#);
459 end if;
460 end Panel_Fitter_Off;
461
Nico Huber4916e342016-11-04 14:37:53 +0100462 procedure Setup_Scaling
463 (Controller : in Controller_Type;
464 Mode : in HW.GFX.Mode_Type;
465 Framebuffer : in HW.GFX.Framebuffer_Type)
466 with
467 Pre =>
Nico Huber9b479412017-08-27 11:55:56 +0200468 Rotated_Width (Framebuffer) <= Mode.H_Visible and
469 Rotated_Height (Framebuffer) <= Mode.V_Visible
Nico Huber4916e342016-11-04 14:37:53 +0100470 is
471 begin
Nico Huber9b479412017-08-27 11:55:56 +0200472 if Rotated_Width (Framebuffer) /= Mode.H_Visible or
473 Rotated_Height (Framebuffer) /= Mode.V_Visible
Nico Huber4916e342016-11-04 14:37:53 +0100474 then
475 if Config.Has_Plane_Control then
476 Setup_Skylake_Pipe_Scaler (Controller, Mode, Framebuffer);
477 else
478 Setup_Ironlake_Panel_Fitter (Controller, Mode, Framebuffer);
479 end if;
Nico Huberb4b72792018-01-02 13:45:41 +0100480 else
481 Panel_Fitter_Off (Controller);
Nico Huber4916e342016-11-04 14:37:53 +0100482 end if;
483 end Setup_Scaling;
484
485 ----------------------------------------------------------------------------
486
Nico Huberf7f537e2018-01-02 14:15:43 +0100487 procedure Setup_FB
488 (Pipe : Pipe_Index;
489 Mode : Mode_Type;
490 Framebuffer : Framebuffer_Type)
491 is
492 -- Enable dithering if framebuffer BPC differs from port BPC,
493 -- as smooth gradients look really bad without.
494 Dither : constant Boolean := Framebuffer.BPC /= Mode.BPC;
495 begin
496 pragma Debug (Debug.Put_Line (GNAT.Source_Info.Enclosing_Entity));
497
498 Setup_Display (Controllers (Pipe), Framebuffer, Mode.BPC, Dither);
499 Setup_Scaling (Controllers (Pipe), Mode, Framebuffer);
500 end Setup_FB;
501
Nico Huber83693c82016-10-08 22:17:55 +0200502 procedure On
Nico Huberf3e23662016-12-05 21:33:03 +0100503 (Pipe : Pipe_Index;
Nico Huber83693c82016-10-08 22:17:55 +0200504 Port_Cfg : Port_Config;
505 Framebuffer : Framebuffer_Type)
506 is
507 begin
508 pragma Debug (Debug.Put_Line (GNAT.Source_Info.Enclosing_Entity));
509
Nico Huber7ad2d652016-12-07 15:19:32 +0100510 Transcoder.Setup (Pipe, Port_Cfg);
Nico Huber83693c82016-10-08 22:17:55 +0200511
Nico Huberf7f537e2018-01-02 14:15:43 +0100512 Setup_FB (Pipe, Port_Cfg.Mode, Framebuffer);
Nico Huber83693c82016-10-08 22:17:55 +0200513
Nico Huberf7f537e2018-01-02 14:15:43 +0100514 Transcoder.On (Pipe, Port_Cfg, Framebuffer.BPC /= Port_Cfg.Mode.BPC);
Nico Huber83693c82016-10-08 22:17:55 +0200515 end On;
516
517 ----------------------------------------------------------------------------
518
519 procedure Planes_Off (Controller : Controller_Type) is
520 begin
Nico Huber7ad2d652016-12-07 15:19:32 +0100521 Registers.Unset_Mask (Controller.SPCNTR, DSPCNTR_ENABLE);
Nico Huber83693c82016-10-08 22:17:55 +0200522 if Config.Has_Plane_Control then
523 Clear_Watermarks (Controller);
524 Registers.Unset_Mask (Controller.PLANE_CTL, PLANE_CTL_PLANE_ENABLE);
525 Registers.Write (Controller.PLANE_SURF, 16#0000_0000#);
526 else
527 Registers.Unset_Mask (Controller.DSPCNTR, DSPCNTR_ENABLE);
528 end if;
529 end Planes_Off;
530
Nico Huber7ad2d652016-12-07 15:19:32 +0100531 procedure Off (Pipe : Pipe_Index)
Nico Huberf3e23662016-12-05 21:33:03 +0100532 is
Nico Huber83693c82016-10-08 22:17:55 +0200533 begin
534 pragma Debug (Debug.Put_Line (GNAT.Source_Info.Enclosing_Entity));
535
Nico Huberf3e23662016-12-05 21:33:03 +0100536 Planes_Off (Controllers (Pipe));
Nico Huber7ad2d652016-12-07 15:19:32 +0100537 Transcoder.Off (Pipe);
Nico Huberf3e23662016-12-05 21:33:03 +0100538 Panel_Fitter_Off (Controllers (Pipe));
Nico Huber7ad2d652016-12-07 15:19:32 +0100539 Transcoder.Clk_Off (Pipe);
Nico Huber83693c82016-10-08 22:17:55 +0200540 end Off;
541
Nico Huber33912aa2016-12-06 20:36:23 +0100542 procedure Legacy_VGA_Off
543 is
544 use type HW.Word8;
545 Reg8 : Word8;
546 begin
547 Port_IO.OutB (VGA_SR_INDEX, VGA_SR01);
548 Port_IO.InB (Reg8, VGA_SR_DATA);
549 Port_IO.OutB (VGA_SR_DATA, Reg8 or VGA_SR01_SCREEN_OFF);
550 Time.U_Delay (100); -- PRM says 100us, Linux does 300
Arthur Heymansdfcdd772018-03-28 16:42:50 +0200551 Registers.Set_Mask (VGACNTRL_REG, VGA_CONTROL_VGA_DISPLAY_DISABLE);
Nico Huber33912aa2016-12-06 20:36:23 +0100552 end Legacy_VGA_Off;
553
Nico Huber83693c82016-10-08 22:17:55 +0200554 procedure All_Off
555 is
Nico Huber83693c82016-10-08 22:17:55 +0200556 begin
557 pragma Debug (Debug.Put_Line (GNAT.Source_Info.Enclosing_Entity));
558
Nico Huber33912aa2016-12-06 20:36:23 +0100559 Legacy_VGA_Off;
560
Nico Huberf3e23662016-12-05 21:33:03 +0100561 for Pipe in Pipe_Index loop
562 Planes_Off (Controllers (Pipe));
Nico Huber7ad2d652016-12-07 15:19:32 +0100563 Transcoder.Off (Pipe);
Nico Huberf3e23662016-12-05 21:33:03 +0100564 Panel_Fitter_Off (Controllers (Pipe));
Nico Huber7ad2d652016-12-07 15:19:32 +0100565 Transcoder.Clk_Off (Pipe);
Nico Huber83693c82016-10-08 22:17:55 +0200566 end loop;
Nico Huber83693c82016-10-08 22:17:55 +0200567 end All_Off;
568
Nico Huber83693c82016-10-08 22:17:55 +0200569end HW.GFX.GMA.Pipe_Setup;