i9xx_display_sr.c

 1// SPDX-License-Identifier: MIT
 2/*
 3 * Copyright © 2024 Intel Corporation
 4 */
 5
 6#include <drm/drm_device.h>
 7
 8#include "i9xx_display_sr.h"
 9#include "i9xx_wm_regs.h"
10#include "intel_de.h"
11#include "intel_display_regs.h"
12#include "intel_gmbus.h"
13#include "intel_pci_config.h"
14
15static void i9xx_display_save_swf(struct intel_display *display)
16{
17	int i;
18
19	/* Scratch space */
20	if (DISPLAY_VER(display) == 2 && display->platform.mobile) {
21		for (i = 0; i < 7; i++) {
22			display->restore.saveSWF0[i] = intel_de_read(display, SWF0(display, i));
23			display->restore.saveSWF1[i] = intel_de_read(display, SWF1(display, i));
24		}
25		for (i = 0; i < 3; i++)
26			display->restore.saveSWF3[i] = intel_de_read(display, SWF3(display, i));
27	} else if (DISPLAY_VER(display) == 2) {
28		for (i = 0; i < 7; i++)
29			display->restore.saveSWF1[i] = intel_de_read(display, SWF1(display, i));
30	} else if (HAS_GMCH(display)) {
31		for (i = 0; i < 16; i++) {
32			display->restore.saveSWF0[i] = intel_de_read(display, SWF0(display, i));
33			display->restore.saveSWF1[i] = intel_de_read(display, SWF1(display, i));
34		}
35		for (i = 0; i < 3; i++)
36			display->restore.saveSWF3[i] = intel_de_read(display, SWF3(display, i));
37	}
38}
39
40static void i9xx_display_restore_swf(struct intel_display *display)
41{
42	int i;
43
44	/* Scratch space */
45	if (DISPLAY_VER(display) == 2 && display->platform.mobile) {
46		for (i = 0; i < 7; i++) {
47			intel_de_write(display, SWF0(display, i), display->restore.saveSWF0[i]);
48			intel_de_write(display, SWF1(display, i), display->restore.saveSWF1[i]);
49		}
50		for (i = 0; i < 3; i++)
51			intel_de_write(display, SWF3(display, i), display->restore.saveSWF3[i]);
52	} else if (DISPLAY_VER(display) == 2) {
53		for (i = 0; i < 7; i++)
54			intel_de_write(display, SWF1(display, i), display->restore.saveSWF1[i]);
55	} else if (HAS_GMCH(display)) {
56		for (i = 0; i < 16; i++) {
57			intel_de_write(display, SWF0(display, i), display->restore.saveSWF0[i]);
58			intel_de_write(display, SWF1(display, i), display->restore.saveSWF1[i]);
59		}
60		for (i = 0; i < 3; i++)
61			intel_de_write(display, SWF3(display, i), display->restore.saveSWF3[i]);
62	}
63}
64
65void i9xx_display_sr_save(struct intel_display *display)
66{
67	struct pci_dev *pdev = to_pci_dev(display->drm->dev);
68
69	if (!HAS_DISPLAY(display))
70		return;
71
72	/* Display arbitration control */
73	if (DISPLAY_VER(display) <= 4)
74		display->restore.saveDSPARB = intel_de_read(display, DSPARB(display));
75
76	if (DISPLAY_VER(display) == 4)
77		pci_read_config_word(pdev, GCDGMBUS, &display->restore.saveGCDGMBUS);
78
79	i9xx_display_save_swf(display);
80}
81
82void i9xx_display_sr_restore(struct intel_display *display)
83{
84	struct pci_dev *pdev = to_pci_dev(display->drm->dev);
85
86	if (!HAS_DISPLAY(display))
87		return;
88
89	i9xx_display_restore_swf(display);
90
91	if (DISPLAY_VER(display) == 4)
92		pci_write_config_word(pdev, GCDGMBUS, display->restore.saveGCDGMBUS);
93
94	/* Display arbitration */
95	if (DISPLAY_VER(display) <= 4)
96		intel_de_write(display, DSPARB(display), display->restore.saveDSPARB);
97}