From: Rob Clark <[email protected]>

Before open-coding this a 2nd time, add a helper.

Signed-off-by: Rob Clark <[email protected]>
---
 drivers/gpu/drm/msm/msm_atomic.c | 21 ++++++---------------
 drivers/gpu/drm/msm/msm_drv.c    | 29 +++++++++++++++++++++++++++++
 drivers/gpu/drm/msm/msm_drv.h    | 22 ++++++++++++++++++++++
 drivers/gpu/drm/msm/msm_kms.h    |  3 +--
 4 files changed, 58 insertions(+), 17 deletions(-)

diff --git a/drivers/gpu/drm/msm/msm_atomic.c b/drivers/gpu/drm/msm/msm_atomic.c
index fab09e7c6efc..27c9ae563f2f 100644
--- a/drivers/gpu/drm/msm/msm_atomic.c
+++ b/drivers/gpu/drm/msm/msm_atomic.c
@@ -116,20 +116,10 @@ static void msm_atomic_async_commit(struct msm_kms *kms, 
int crtc_idx)
        trace_msm_atomic_async_commit_finish(crtc_mask);
 }
 
-static enum hrtimer_restart msm_atomic_pending_timer(struct hrtimer *t)
-{
-       struct msm_pending_timer *timer = container_of(t,
-                       struct msm_pending_timer, timer);
-
-       kthread_queue_work(timer->worker, &timer->work);
-
-       return HRTIMER_NORESTART;
-}
-
 static void msm_atomic_pending_work(struct kthread_work *work)
 {
        struct msm_pending_timer *timer = container_of(work,
-                       struct msm_pending_timer, work);
+                       struct msm_pending_timer, work.work);
 
        msm_atomic_async_commit(timer->kms, timer->crtc_idx);
 }
@@ -139,8 +129,6 @@ int msm_atomic_init_pending_timer(struct msm_pending_timer 
*timer,
 {
        timer->kms = kms;
        timer->crtc_idx = crtc_idx;
-       hrtimer_init(&timer->timer, CLOCK_MONOTONIC, HRTIMER_MODE_ABS);
-       timer->timer.function = msm_atomic_pending_timer;
 
        timer->worker = kthread_create_worker(0, "atomic-worker-%d", crtc_idx);
        if (IS_ERR(timer->worker)) {
@@ -149,7 +137,10 @@ int msm_atomic_init_pending_timer(struct msm_pending_timer 
*timer,
                return ret;
        }
        sched_set_fifo(timer->worker->task);
-       kthread_init_work(&timer->work, msm_atomic_pending_work);
+
+       msm_hrtimer_work_init(&timer->work, timer->worker,
+                             msm_atomic_pending_work,
+                             CLOCK_MONOTONIC, HRTIMER_MODE_ABS);
 
        return 0;
 }
@@ -258,7 +249,7 @@ void msm_atomic_commit_tail(struct drm_atomic_state *state)
                        vsync_time = kms->funcs->vsync_time(kms, async_crtc);
                        wakeup_time = ktime_sub(vsync_time, ms_to_ktime(1));
 
-                       hrtimer_start(&timer->timer, wakeup_time,
+                       msm_hrtimer_queue_work(&timer->work, wakeup_time,
                                        HRTIMER_MODE_ABS);
                }
 
diff --git a/drivers/gpu/drm/msm/msm_drv.c b/drivers/gpu/drm/msm/msm_drv.c
index 938765ad7109..624078b3adf2 100644
--- a/drivers/gpu/drm/msm/msm_drv.c
+++ b/drivers/gpu/drm/msm/msm_drv.c
@@ -200,6 +200,35 @@ void msm_rmw(void __iomem *addr, u32 mask, u32 or)
        msm_writel(val | or, addr);
 }
 
+static enum hrtimer_restart msm_hrtimer_worktimer(struct hrtimer *t)
+{
+       struct msm_hrtimer_work *work = container_of(t,
+                       struct msm_hrtimer_work, timer);
+
+       kthread_queue_work(work->worker, &work->work);
+
+       return HRTIMER_NORESTART;
+}
+
+void msm_hrtimer_queue_work(struct msm_hrtimer_work *work,
+                           ktime_t wakeup_time,
+                           enum hrtimer_mode mode)
+{
+       hrtimer_start(&work->timer, wakeup_time, mode);
+}
+
+void msm_hrtimer_work_init(struct msm_hrtimer_work *work,
+                          struct kthread_worker *worker,
+                          kthread_work_func_t fn,
+                          clockid_t clock_id,
+                          enum hrtimer_mode mode)
+{
+       hrtimer_init(&work->timer, clock_id, mode);
+       work->timer.function = msm_hrtimer_worktimer;
+       work->worker = worker;
+       kthread_init_work(&work->work, fn);
+}
+
 static irqreturn_t msm_irq(int irq, void *arg)
 {
        struct drm_device *dev = arg;
diff --git a/drivers/gpu/drm/msm/msm_drv.h b/drivers/gpu/drm/msm/msm_drv.h
index 8b005d1ac899..de062450add4 100644
--- a/drivers/gpu/drm/msm/msm_drv.h
+++ b/drivers/gpu/drm/msm/msm_drv.h
@@ -488,6 +488,28 @@ void msm_writel(u32 data, void __iomem *addr);
 u32 msm_readl(const void __iomem *addr);
 void msm_rmw(void __iomem *addr, u32 mask, u32 or);
 
+/**
+ * struct msm_hrtimer_work - a helper to combine an hrtimer with kthread_work
+ *
+ * @timer: hrtimer to control when the kthread work is triggered
+ * @work:  the kthread work
+ * @worker: the kthread worker the work will be scheduled on
+ */
+struct msm_hrtimer_work {
+       struct hrtimer timer;
+       struct kthread_work work;
+       struct kthread_worker *worker;
+};
+
+void msm_hrtimer_queue_work(struct msm_hrtimer_work *work,
+                           ktime_t wakeup_time,
+                           enum hrtimer_mode mode);
+void msm_hrtimer_work_init(struct msm_hrtimer_work *work,
+                          struct kthread_worker *worker,
+                          kthread_work_func_t fn,
+                          clockid_t clock_id,
+                          enum hrtimer_mode mode);
+
 struct msm_gpu_submitqueue;
 int msm_submitqueue_init(struct drm_device *drm, struct msm_file_private *ctx);
 struct msm_gpu_submitqueue *msm_submitqueue_get(struct msm_file_private *ctx,
diff --git a/drivers/gpu/drm/msm/msm_kms.h b/drivers/gpu/drm/msm/msm_kms.h
index de2bc3467bb5..6a42b819abc4 100644
--- a/drivers/gpu/drm/msm/msm_kms.h
+++ b/drivers/gpu/drm/msm/msm_kms.h
@@ -136,8 +136,7 @@ struct msm_kms;
  * shortly before vblank to flush pending async updates.
  */
 struct msm_pending_timer {
-       struct hrtimer timer;
-       struct kthread_work work;
+       struct msm_hrtimer_work work;
        struct kthread_worker *worker;
        struct msm_kms *kms;
        unsigned crtc_idx;
-- 
2.31.1

Reply via email to