Add a basic PM support to mgag200 driver.
As there is no hardware specific init codes for this device, the
callbacks are written in a fairly simple way.

Signed-off-by: Takashi Iwai <tiwai at suse.de>
---
 drivers/gpu/drm/mgag200/mgag200_drv.c | 75 +++++++++++++++++++++++++++++++++++
 drivers/gpu/drm/mgag200/mgag200_drv.h |  1 +
 drivers/gpu/drm/mgag200/mgag200_fb.c  |  5 +++
 3 files changed, 81 insertions(+)

diff --git a/drivers/gpu/drm/mgag200/mgag200_drv.c 
b/drivers/gpu/drm/mgag200/mgag200_drv.c
index f15ea3c4a90a..35ef919788e4 100644
--- a/drivers/gpu/drm/mgag200/mgag200_drv.c
+++ b/drivers/gpu/drm/mgag200/mgag200_drv.c
@@ -11,6 +11,7 @@
 #include <linux/module.h>
 #include <linux/console.h>
 #include <drm/drmP.h>
+#include <drm/drm_crtc_helper.h>

 #include "mgag200_drv.h"

@@ -74,6 +75,79 @@ static void mga_pci_remove(struct pci_dev *pdev)
        drm_put_dev(dev);
 }

+static int mgag200_pm_freeze(struct device *dev)
+{
+       struct drm_device *drm_dev = dev_get_drvdata(dev);
+       struct mga_device *mdev = drm_dev->dev_private;
+       struct drm_connector *connector;
+
+       drm_kms_helper_poll_disable(drm_dev);
+       list_for_each_entry(connector, &drm_dev->mode_config.connector_list,
+                           head)
+               drm_helper_connector_dpms(connector, DRM_MODE_DPMS_OFF);
+
+       console_lock();
+       mgag200_fbdev_set_suspend(mdev, FBINFO_STATE_SUSPENDED);
+       console_unlock();
+
+       return 0;
+}
+
+static int mgag200_pm_thaw(struct device *dev)
+{
+       struct drm_device *drm_dev = dev_get_drvdata(dev);
+       struct mga_device *mdev = drm_dev->dev_private;
+       struct drm_connector *connector;
+
+       console_lock();
+       mgag200_fbdev_set_suspend(mdev, FBINFO_STATE_RUNNING);
+       console_unlock();
+
+       drm_helper_resume_force_mode(drm_dev);
+       list_for_each_entry(connector, &drm_dev->mode_config.connector_list,
+                           head)
+               drm_helper_connector_dpms(connector, DRM_MODE_DPMS_ON);
+
+       drm_kms_helper_poll_enable(drm_dev);
+       return 0;
+}
+
+static int mgag200_pm_suspend(struct device *dev)
+{
+       struct pci_dev *pdev = to_pci_dev(dev);
+       int err;
+
+       err = mgag200_pm_freeze(dev);
+       if (err)
+               return err;
+
+       pci_save_state(pdev);
+       pci_disable_device(pdev);
+       pci_set_power_state(pdev, PCI_D3hot);
+       return 0;
+}
+
+static int mgag200_pm_resume(struct device *dev)
+{
+       struct pci_dev *pdev = to_pci_dev(dev);
+
+       pci_set_power_state(pdev, PCI_D0);
+       pci_restore_state(pdev);
+       if (pci_enable_device(pdev))
+               return -EIO;
+
+       return mgag200_pm_thaw(dev);
+}
+
+static const struct dev_pm_ops mgag200_pm_ops = {
+       .suspend = mgag200_pm_suspend,
+       .resume = mgag200_pm_resume,
+       .freeze = mgag200_pm_freeze,
+       .thaw = mgag200_pm_thaw,
+       .poweroff = mgag200_pm_freeze,
+       .restore = mgag200_pm_resume,
+};
+
 static const struct file_operations mgag200_driver_fops = {
        .owner = THIS_MODULE,
        .open = drm_open,
@@ -110,6 +184,7 @@ static struct pci_driver mgag200_pci_driver = {
        .id_table = pciidlist,
        .probe = mga_pci_probe,
        .remove = mga_pci_remove,
+       .driver.pm = &mgag200_pm_ops,
 };

 static int __init mgag200_init(void)
diff --git a/drivers/gpu/drm/mgag200/mgag200_drv.h 
b/drivers/gpu/drm/mgag200/mgag200_drv.h
index cf11ee68a6d9..493f56d6f421 100644
--- a/drivers/gpu/drm/mgag200/mgag200_drv.h
+++ b/drivers/gpu/drm/mgag200/mgag200_drv.h
@@ -247,6 +247,7 @@ void mgag200_modeset_fini(struct mga_device *mdev);
                                /* mgag200_fb.c */
 int mgag200_fbdev_init(struct mga_device *mdev);
 void mgag200_fbdev_fini(struct mga_device *mdev);
+void mgag200_fbdev_set_suspend(struct mga_device *mdev, int state);

                                /* mgag200_main.c */
 int mgag200_framebuffer_init(struct drm_device *dev,
diff --git a/drivers/gpu/drm/mgag200/mgag200_fb.c 
b/drivers/gpu/drm/mgag200/mgag200_fb.c
index 13b7dd83faa9..0fdb8b247541 100644
--- a/drivers/gpu/drm/mgag200/mgag200_fb.c
+++ b/drivers/gpu/drm/mgag200/mgag200_fb.c
@@ -318,3 +318,8 @@ void mgag200_fbdev_fini(struct mga_device *mdev)

        mga_fbdev_destroy(mdev->dev, mdev->mfbdev);
 }
+
+void mgag200_fbdev_set_suspend(struct mga_device *mdev, int state)
+{
+       fb_set_suspend(mdev->mfbdev->helper.fbdev, state);
+}
-- 
1.9.2

Reply via email to