drm/nv40/pm: implement first type of pwm fanspeed funcs

[karo-tx-linux.git] / drivers / gpu / drm / nouveau / nv40_pm.c

diff --git a/drivers/gpu/drm/nouveau/nv40_pm.c b/drivers/gpu/drm/nouveau/nv40_pm.c
index e676b0d534786ee140017691b83c4580e0e6bbc3..c969bcbab5474b2f756e9dbd79be2e24341dd864 100644 (file)
--- a/drivers/gpu/drm/nouveau/nv40_pm.c
+++ b/drivers/gpu/drm/nouveau/nv40_pm.c
@@ -346,3 +346,29 @@ resume:
 
        kfree(info);
 }
+
+int
+nv40_pm_fanspeed_get(struct drm_device *dev)
+{
+       u32 reg = nv_rd32(dev, 0x0010f0);
+       if (reg & 0x80000000) {
+               u32 duty = (reg & 0x7fff0000) >> 16;
+               u32 divs = (reg & 0x00007fff);
+               if (divs && divs >= duty)
+                       return ((divs - duty) * 100) / divs;
+       }
+
+       return 100;
+}
+
+int
+nv40_pm_fanspeed_set(struct drm_device *dev, int percent)
+{
+       struct drm_nouveau_private *dev_priv = dev->dev_private;
+       struct nouveau_pm_engine *pm = &dev_priv->engine.pm;
+       u32 divs = pm->pwm_divisor;
+       u32 duty = ((100 - percent) * divs) / 100;
+
+       nv_wr32(dev, 0x0010f0, 0x80000000 | (duty << 16) | divs);
+       return 0;
+}