LXR linux/drivers/gpu/drm/msm/disp/mdp

   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
  12struct mdp_irq_wait {
  13        struct mdp_irq irq;
  14        int count;
  15};
  16
  17static DECLARE_WAIT_QUEUE_HEAD(wait_event);
  18
  19static DEFINE_SPINLOCK(list_lock);
  20
  21static 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 */
  38void 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
  46void 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
  66void 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
  79static 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
  87void 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
 102void 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
 121void 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}
 139