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

   1 /*
   2  * Copyright (C) 2013 Red Hat
   3  * Author: Rob Clark <robdclark@gmail.com>
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of the GNU General Public License version 2 as published by
   7  * the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  12  * more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along with
  15  * this program.  If not, see <http://www.gnu.org/licenses/>.
  16  */
  17
  18
  19 #include "msm_drv.h"
  20 #include "mdp_kms.h"
  21
  22
  23 struct mdp_irq_wait {
  24         struct mdp_irq irq;
  25         int count;
  26 };
  27
  28 static DECLARE_WAIT_QUEUE_HEAD(wait_event);
  29
  30 static DEFINE_SPINLOCK(list_lock);
  31
  32 static void update_irq(struct mdp_kms *mdp_kms)
  33 {
  34         struct mdp_irq *irq;
  35         uint32_t irqmask = mdp_kms->vblank_mask;
  36
  37         assert_spin_locked(&list_lock);
  38
  39         list_for_each_entry(irq, &mdp_kms->irq_list, node)
  40                 irqmask |= irq->irqmask;
  41
  42         mdp_kms->funcs->set_irqmask(mdp_kms, irqmask, mdp_kms->cur_irq_mask);
  43         mdp_kms->cur_irq_mask = irqmask;
  44 }
  45
  46 /* if an mdp_irq's irqmask has changed, such as when mdp5 crtc<->encoder
  47  * link changes, this must be called to figure out the new global irqmask
  48  */
  49 void mdp_irq_update(struct mdp_kms *mdp_kms)
  50 {
  51         unsigned long flags;
  52         spin_lock_irqsave(&list_lock, flags);
  53         update_irq(mdp_kms);
  54         spin_unlock_irqrestore(&list_lock, flags);
  55 }
  56
  57 void mdp_dispatch_irqs(struct mdp_kms *mdp_kms, uint32_t status)
  58 {
  59         struct mdp_irq *handler, *n;
  60         unsigned long flags;
  61
  62         spin_lock_irqsave(&list_lock, flags);
  63         mdp_kms->in_irq = true;
  64         list_for_each_entry_safe(handler, n, &mdp_kms->irq_list, node) {
  65                 if (handler->irqmask & status) {
  66                         spin_unlock_irqrestore(&list_lock, flags);
  67                         handler->irq(handler, handler->irqmask & status);
  68                         spin_lock_irqsave(&list_lock, flags);
  69                 }
  70         }
  71         mdp_kms->in_irq = false;
  72         update_irq(mdp_kms);
  73         spin_unlock_irqrestore(&list_lock, flags);
  74
  75 }
  76
  77 void mdp_update_vblank_mask(struct mdp_kms *mdp_kms, uint32_t mask, bool enable)
  78 {
  79         unsigned long flags;
  80
  81         spin_lock_irqsave(&list_lock, flags);
  82         if (enable)
  83                 mdp_kms->vblank_mask |= mask;
  84         else
  85                 mdp_kms->vblank_mask &= ~mask;
  86         update_irq(mdp_kms);
  87         spin_unlock_irqrestore(&list_lock, flags);
  88 }
  89
  90 static void wait_irq(struct mdp_irq *irq, uint32_t irqstatus)
  91 {
  92         struct mdp_irq_wait *wait =
  93                         container_of(irq, struct mdp_irq_wait, irq);
  94         wait->count--;
  95         wake_up_all(&wait_event);
  96 }
  97
  98 void mdp_irq_wait(struct mdp_kms *mdp_kms, uint32_t irqmask)
  99 {
 100         struct mdp_irq_wait wait = {
 101                 .irq = {
 102                         .irq = wait_irq,
 103                         .irqmask = irqmask,
 104                 },
 105                 .count = 1,
 106         };
 107         mdp_irq_register(mdp_kms, &wait.irq);
 108         wait_event_timeout(wait_event, (wait.count <= 0),
 109                         msecs_to_jiffies(100));
 110         mdp_irq_unregister(mdp_kms, &wait.irq);
 111 }
 112
 113 void mdp_irq_register(struct mdp_kms *mdp_kms, struct mdp_irq *irq)
 114 {
 115         unsigned long flags;
 116         bool needs_update = false;
 117
 118         spin_lock_irqsave(&list_lock, flags);
 119
 120         if (!irq->registered) {
 121                 irq->registered = true;
 122                 list_add(&irq->node, &mdp_kms->irq_list);
 123                 needs_update = !mdp_kms->in_irq;
 124         }
 125
 126         spin_unlock_irqrestore(&list_lock, flags);
 127
 128         if (needs_update)
 129                 mdp_irq_update(mdp_kms);
 130 }
 131
 132 void mdp_irq_unregister(struct mdp_kms *mdp_kms, struct mdp_irq *irq)
 133 {
 134         unsigned long flags;
 135         bool needs_update = false;
 136
 137         spin_lock_irqsave(&list_lock, flags);
 138
 139         if (irq->registered) {
 140                 irq->registered = false;
 141                 list_del(&irq->node);
 142                 needs_update = !mdp_kms->in_irq;
 143         }
 144
 145         spin_unlock_irqrestore(&list_lock, flags);
 146
 147         if (needs_update)
 148                 mdp_irq_update(mdp_kms);
 149 }