1 files changed, 31 insertions, 1 deletions

diff --git a/drivers/gpu/nvgpu/common/pmu/pmu_pg.c b/drivers/gpu/nvgpu/common/pmu/pmu_pg.c
index 3d46298d..941cee75 100644
--- a/drivers/gpu/nvgpu/common/pmu/pmu_pg.c
+++ b/drivers/gpu/nvgpu/common/pmu/pmu_pg.c
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2016-2018, NVIDIA CORPORATION.  All rights reserved.
+ * Copyright (c) 2016-2019, NVIDIA CORPORATION.  All rights reserved.
  *
  * Permission is hereby granted, free of charge, to any person obtaining a
  * copy of this software and associated documentation files (the "Software"),
@@ -359,6 +359,36 @@ exit_unlock:
         return ret;
 }
 
+int nvgpu_pmu_reenable_elpg(struct gk20a *g)
+{
+        struct nvgpu_pmu *pmu = &g->pmu;
+        int ret = 0;
+
+        nvgpu_log_fn(g, " ");
+
+        if (!g->support_pmu) {
+                return ret;
+        }
+
+        /* If pmu enabled, re-enable by first disabling, then
+         * enabling
+         */
+        if (pmu->elpg_refcnt != 0) {
+                ret = nvgpu_pmu_disable_elpg(g);
+                if (ret != 0) {
+                        nvgpu_err(g, "failed disabling elpg");
+                        goto exit;
+                }
+                ret = nvgpu_pmu_enable_elpg(g);
+                if (ret != 0) {
+                        nvgpu_err(g, "failed enabling elpg");
+                        goto exit;
+                }
+        }
+exit:
+        return ret;
+}
+
 /* PG init */
 static void pmu_handle_pg_stat_msg(struct gk20a *g, struct pmu_msg *msg,
                         void *param, u32 handle, u32 status)