drivers/gpu/drm/msm/disp/mdp_kms.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (C) 2013 Red Hat
   4  * Author: Rob Clark <robdclark@gmail.com>
   5  */
   6
   7
   8 #include "msm_drv.h"
   9 #include "mdp_kms.h"
  10
  11
  12 struct mdp_irq_wait {
  13         struct mdp_irq irq;
  14         int count;
  15 };
  16
  17 static DECLARE_WAIT_QUEUE_HEAD(wait_event);
  18
  19 static DEFINE_SPINLOCK(list_lock);
  20
  21 static void update_irq(struct mdp_kms *mdp_kms)
  22 {
  23         struct mdp_irq *irq;
  24         uint32_t irqmask = mdp_kms->vblank_mask;
  25
  26         assert_spin_locked(&list_lock);
  27
  28         list_for_each_entry(irq, &mdp_kms->irq_list, node)
  29                 irqmask |= irq->irqmask;
  30
  31         mdp_kms->funcs->set_irqmask(mdp_kms, irqmask, mdp_kms->cur_irq_mask);
  32         mdp_kms->cur_irq_mask = irqmask;
  33 }
  34
  35 /* if an mdp_irq's irqmask has changed, such as when mdp5 crtc<->encoder
  36  * link changes, this must be called to figure out the new global irqmask
  37  */
  38 void mdp_irq_update(struct mdp_kms *mdp_kms)
  39 {
  40         unsigned long flags;
  41         spin_lock_irqsave(&list_lock, flags);
  42         update_irq(mdp_kms);
  43         spin_unlock_irqrestore(&list_lock, flags);
  44 }
  45
  46 void mdp_dispatch_irqs(struct mdp_kms *mdp_kms, uint32_t status)
  47 {
  48         struct mdp_irq *handler, *n;
  49         unsigned long flags;
  50
  51         spin_lock_irqsave(&list_lock, flags);
  52         mdp_kms->in_irq = true;
  53         list_for_each_entry_safe(handler, n, &mdp_kms->irq_list, node) {
  54                 if (handler->irqmask & status) {
  55                         spin_unlock_irqrestore(&list_lock, flags);
  56                         handler->irq(handler, handler->irqmask & status);
  57                         spin_lock_irqsave(&list_lock, flags);
  58                 }
  59         }
  60         mdp_kms->in_irq = false;
  61         update_irq(mdp_kms);
  62         spin_unlock_irqrestore(&list_lock, flags);
  63
  64 }
  65
  66 void mdp_update_vblank_mask(struct mdp_kms *mdp_kms, uint32_t mask, bool enable)
  67 {
  68         unsigned long flags;
  69
  70         spin_lock_irqsave(&list_lock, flags);
  71         if (enable)
  72                 mdp_kms->vblank_mask |= mask;
  73         else
  74                 mdp_kms->vblank_mask &= ~mask;
  75         update_irq(mdp_kms);
  76         spin_unlock_irqrestore(&list_lock, flags);
  77 }
  78
  79 static void wait_irq(struct mdp_irq *irq, uint32_t irqstatus)
  80 {
  81         struct mdp_irq_wait *wait =
  82                         container_of(irq, struct mdp_irq_wait, irq);
  83         wait->count--;
  84         wake_up_all(&wait_event);
  85 }
  86
  87 void mdp_irq_wait(struct mdp_kms *mdp_kms, uint32_t irqmask)
  88 {
  89         struct mdp_irq_wait wait = {
  90                 .irq = {
  91                         .irq = wait_irq,
  92                         .irqmask = irqmask,
  93                 },
  94                 .count = 1,
  95         };
  96         mdp_irq_register(mdp_kms, &wait.irq);
  97         wait_event_timeout(wait_event, (wait.count <= 0),
  98                         msecs_to_jiffies(100));
  99         mdp_irq_unregister(mdp_kms, &wait.irq);
 100 }
 101
 102 void mdp_irq_register(struct mdp_kms *mdp_kms, struct mdp_irq *irq)
 103 {
 104         unsigned long flags;
 105         bool needs_update = false;
 106
 107         spin_lock_irqsave(&list_lock, flags);
 108
 109         if (!irq->registered) {
 110                 irq->registered = true;
 111                 list_add(&irq->node, &mdp_kms->irq_list);
 112                 needs_update = !mdp_kms->in_irq;
 113         }
 114
 115         spin_unlock_irqrestore(&list_lock, flags);
 116
 117         if (needs_update)
 118                 mdp_irq_update(mdp_kms);
 119 }
 120
 121 void mdp_irq_unregister(struct mdp_kms *mdp_kms, struct mdp_irq *irq)
 122 {
 123         unsigned long flags;
 124         bool needs_update = false;
 125
 126         spin_lock_irqsave(&list_lock, flags);
 127
 128         if (irq->registered) {
 129                 irq->registered = false;
 130                 list_del(&irq->node);
 131                 needs_update = !mdp_kms->in_irq;
 132         }
 133
 134         spin_unlock_irqrestore(&list_lock, flags);
 135
 136         if (needs_update)
 137                 mdp_irq_update(mdp_kms);
 138 }