162306a36Sopenharmony_ci/*
262306a36Sopenharmony_ci *
362306a36Sopenharmony_ci * Copyright 2008 (c) Intel Corporation
462306a36Sopenharmony_ci *   Jesse Barnes <jbarnes@virtuousgeek.org>
562306a36Sopenharmony_ci *
662306a36Sopenharmony_ci * Permission is hereby granted, free of charge, to any person obtaining a
762306a36Sopenharmony_ci * copy of this software and associated documentation files (the
862306a36Sopenharmony_ci * "Software"), to deal in the Software without restriction, including
962306a36Sopenharmony_ci * without limitation the rights to use, copy, modify, merge, publish,
1062306a36Sopenharmony_ci * distribute, sub license, and/or sell copies of the Software, and to
1162306a36Sopenharmony_ci * permit persons to whom the Software is furnished to do so, subject to
1262306a36Sopenharmony_ci * the following conditions:
1362306a36Sopenharmony_ci *
1462306a36Sopenharmony_ci * The above copyright notice and this permission notice (including the
1562306a36Sopenharmony_ci * next paragraph) shall be included in all copies or substantial portions
1662306a36Sopenharmony_ci * of the Software.
1762306a36Sopenharmony_ci *
1862306a36Sopenharmony_ci * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
1962306a36Sopenharmony_ci * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
2062306a36Sopenharmony_ci * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT.
2162306a36Sopenharmony_ci * IN NO EVENT SHALL TUNGSTEN GRAPHICS AND/OR ITS SUPPLIERS BE LIABLE FOR
2262306a36Sopenharmony_ci * ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT,
2362306a36Sopenharmony_ci * TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE
2462306a36Sopenharmony_ci * SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
2562306a36Sopenharmony_ci */
2662306a36Sopenharmony_ci
2762306a36Sopenharmony_ci#include "display/intel_de.h"
2862306a36Sopenharmony_ci#include "display/intel_gmbus.h"
2962306a36Sopenharmony_ci#include "display/intel_vga.h"
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_ci#include "i915_drv.h"
3262306a36Sopenharmony_ci#include "i915_reg.h"
3362306a36Sopenharmony_ci#include "i915_suspend.h"
3462306a36Sopenharmony_ci#include "intel_pci_config.h"
3562306a36Sopenharmony_ci
3662306a36Sopenharmony_cistatic void intel_save_swf(struct drm_i915_private *dev_priv)
3762306a36Sopenharmony_ci{
3862306a36Sopenharmony_ci	int i;
3962306a36Sopenharmony_ci
4062306a36Sopenharmony_ci	/* Scratch space */
4162306a36Sopenharmony_ci	if (GRAPHICS_VER(dev_priv) == 2 && IS_MOBILE(dev_priv)) {
4262306a36Sopenharmony_ci		for (i = 0; i < 7; i++) {
4362306a36Sopenharmony_ci			dev_priv->regfile.saveSWF0[i] = intel_de_read(dev_priv, SWF0(i));
4462306a36Sopenharmony_ci			dev_priv->regfile.saveSWF1[i] = intel_de_read(dev_priv, SWF1(i));
4562306a36Sopenharmony_ci		}
4662306a36Sopenharmony_ci		for (i = 0; i < 3; i++)
4762306a36Sopenharmony_ci			dev_priv->regfile.saveSWF3[i] = intel_de_read(dev_priv, SWF3(i));
4862306a36Sopenharmony_ci	} else if (GRAPHICS_VER(dev_priv) == 2) {
4962306a36Sopenharmony_ci		for (i = 0; i < 7; i++)
5062306a36Sopenharmony_ci			dev_priv->regfile.saveSWF1[i] = intel_de_read(dev_priv, SWF1(i));
5162306a36Sopenharmony_ci	} else if (HAS_GMCH(dev_priv)) {
5262306a36Sopenharmony_ci		for (i = 0; i < 16; i++) {
5362306a36Sopenharmony_ci			dev_priv->regfile.saveSWF0[i] = intel_de_read(dev_priv, SWF0(i));
5462306a36Sopenharmony_ci			dev_priv->regfile.saveSWF1[i] = intel_de_read(dev_priv, SWF1(i));
5562306a36Sopenharmony_ci		}
5662306a36Sopenharmony_ci		for (i = 0; i < 3; i++)
5762306a36Sopenharmony_ci			dev_priv->regfile.saveSWF3[i] = intel_de_read(dev_priv, SWF3(i));
5862306a36Sopenharmony_ci	}
5962306a36Sopenharmony_ci}
6062306a36Sopenharmony_ci
6162306a36Sopenharmony_cistatic void intel_restore_swf(struct drm_i915_private *dev_priv)
6262306a36Sopenharmony_ci{
6362306a36Sopenharmony_ci	int i;
6462306a36Sopenharmony_ci
6562306a36Sopenharmony_ci	/* Scratch space */
6662306a36Sopenharmony_ci	if (GRAPHICS_VER(dev_priv) == 2 && IS_MOBILE(dev_priv)) {
6762306a36Sopenharmony_ci		for (i = 0; i < 7; i++) {
6862306a36Sopenharmony_ci			intel_de_write(dev_priv, SWF0(i), dev_priv->regfile.saveSWF0[i]);
6962306a36Sopenharmony_ci			intel_de_write(dev_priv, SWF1(i), dev_priv->regfile.saveSWF1[i]);
7062306a36Sopenharmony_ci		}
7162306a36Sopenharmony_ci		for (i = 0; i < 3; i++)
7262306a36Sopenharmony_ci			intel_de_write(dev_priv, SWF3(i), dev_priv->regfile.saveSWF3[i]);
7362306a36Sopenharmony_ci	} else if (GRAPHICS_VER(dev_priv) == 2) {
7462306a36Sopenharmony_ci		for (i = 0; i < 7; i++)
7562306a36Sopenharmony_ci			intel_de_write(dev_priv, SWF1(i), dev_priv->regfile.saveSWF1[i]);
7662306a36Sopenharmony_ci	} else if (HAS_GMCH(dev_priv)) {
7762306a36Sopenharmony_ci		for (i = 0; i < 16; i++) {
7862306a36Sopenharmony_ci			intel_de_write(dev_priv, SWF0(i), dev_priv->regfile.saveSWF0[i]);
7962306a36Sopenharmony_ci			intel_de_write(dev_priv, SWF1(i), dev_priv->regfile.saveSWF1[i]);
8062306a36Sopenharmony_ci		}
8162306a36Sopenharmony_ci		for (i = 0; i < 3; i++)
8262306a36Sopenharmony_ci			intel_de_write(dev_priv, SWF3(i), dev_priv->regfile.saveSWF3[i]);
8362306a36Sopenharmony_ci	}
8462306a36Sopenharmony_ci}
8562306a36Sopenharmony_ci
8662306a36Sopenharmony_civoid i915_save_display(struct drm_i915_private *dev_priv)
8762306a36Sopenharmony_ci{
8862306a36Sopenharmony_ci	struct pci_dev *pdev = to_pci_dev(dev_priv->drm.dev);
8962306a36Sopenharmony_ci
9062306a36Sopenharmony_ci	if (!HAS_DISPLAY(dev_priv))
9162306a36Sopenharmony_ci		return;
9262306a36Sopenharmony_ci
9362306a36Sopenharmony_ci	/* Display arbitration control */
9462306a36Sopenharmony_ci	if (GRAPHICS_VER(dev_priv) <= 4)
9562306a36Sopenharmony_ci		dev_priv->regfile.saveDSPARB = intel_de_read(dev_priv, DSPARB);
9662306a36Sopenharmony_ci
9762306a36Sopenharmony_ci	if (GRAPHICS_VER(dev_priv) == 4)
9862306a36Sopenharmony_ci		pci_read_config_word(pdev, GCDGMBUS,
9962306a36Sopenharmony_ci				     &dev_priv->regfile.saveGCDGMBUS);
10062306a36Sopenharmony_ci
10162306a36Sopenharmony_ci	intel_save_swf(dev_priv);
10262306a36Sopenharmony_ci}
10362306a36Sopenharmony_ci
10462306a36Sopenharmony_civoid i915_restore_display(struct drm_i915_private *dev_priv)
10562306a36Sopenharmony_ci{
10662306a36Sopenharmony_ci	struct pci_dev *pdev = to_pci_dev(dev_priv->drm.dev);
10762306a36Sopenharmony_ci
10862306a36Sopenharmony_ci	if (!HAS_DISPLAY(dev_priv))
10962306a36Sopenharmony_ci		return;
11062306a36Sopenharmony_ci
11162306a36Sopenharmony_ci	intel_restore_swf(dev_priv);
11262306a36Sopenharmony_ci
11362306a36Sopenharmony_ci	if (GRAPHICS_VER(dev_priv) == 4)
11462306a36Sopenharmony_ci		pci_write_config_word(pdev, GCDGMBUS,
11562306a36Sopenharmony_ci				      dev_priv->regfile.saveGCDGMBUS);
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_ci	/* Display arbitration */
11862306a36Sopenharmony_ci	if (GRAPHICS_VER(dev_priv) <= 4)
11962306a36Sopenharmony_ci		intel_de_write(dev_priv, DSPARB, dev_priv->regfile.saveDSPARB);
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_ci	intel_vga_redisable(dev_priv);
12262306a36Sopenharmony_ci
12362306a36Sopenharmony_ci	intel_gmbus_reset(dev_priv);
12462306a36Sopenharmony_ci}
125