msm/disp/mdp_kms.c

0001 // SPDX-License-Identifier: GPL-2.0-only
0002 /*
0003  * Copyright (C) 2013 Red Hat
0004  * Author: Rob Clark <robdclark@gmail.com>
0005  */
0006
0007
0008 #include "msm_drv.h"
0009 #include "mdp_kms.h"
0010
0011
0012 struct mdp_irq_wait {
0013     struct mdp_irq irq;
0014     int count;
0015 };
0016
0017 static DECLARE_WAIT_QUEUE_HEAD(wait_event);
0018
0019 static DEFINE_SPINLOCK(list_lock);
0020
0021 static void update_irq(struct mdp_kms *mdp_kms)
0022 {
0023     struct mdp_irq *irq;
0024     uint32_t irqmask = mdp_kms->vblank_mask;
0025
0026     assert_spin_locked(&list_lock);
0027
0028     list_for_each_entry(irq, &mdp_kms->irq_list, node)
0029         irqmask |= irq->irqmask;
0030
0031     mdp_kms->funcs->set_irqmask(mdp_kms, irqmask, mdp_kms->cur_irq_mask);
0032     mdp_kms->cur_irq_mask = irqmask;
0033 }
0034
0035 /* if an mdp_irq's irqmask has changed, such as when mdp5 crtc<->encoder
0036  * link changes, this must be called to figure out the new global irqmask
0037  */
0038 void mdp_irq_update(struct mdp_kms *mdp_kms)
0039 {
0040     unsigned long flags;
0041     spin_lock_irqsave(&list_lock, flags);
0042     update_irq(mdp_kms);
0043     spin_unlock_irqrestore(&list_lock, flags);
0044 }
0045
0046 void mdp_dispatch_irqs(struct mdp_kms *mdp_kms, uint32_t status)
0047 {
0048     struct mdp_irq *handler, *n;
0049     unsigned long flags;
0050
0051     spin_lock_irqsave(&list_lock, flags);
0052     mdp_kms->in_irq = true;
0053     list_for_each_entry_safe(handler, n, &mdp_kms->irq_list, node) {
0054         if (handler->irqmask & status) {
0055             spin_unlock_irqrestore(&list_lock, flags);
0056             handler->irq(handler, handler->irqmask & status);
0057             spin_lock_irqsave(&list_lock, flags);
0058         }
0059     }
0060     mdp_kms->in_irq = false;
0061     update_irq(mdp_kms);
0062     spin_unlock_irqrestore(&list_lock, flags);
0063
0064 }
0065
0066 void mdp_update_vblank_mask(struct mdp_kms *mdp_kms, uint32_t mask, bool enable)
0067 {
0068     unsigned long flags;
0069
0070     spin_lock_irqsave(&list_lock, flags);
0071     if (enable)
0072         mdp_kms->vblank_mask |= mask;
0073     else
0074         mdp_kms->vblank_mask &= ~mask;
0075     update_irq(mdp_kms);
0076     spin_unlock_irqrestore(&list_lock, flags);
0077 }
0078
0079 static void wait_irq(struct mdp_irq *irq, uint32_t irqstatus)
0080 {
0081     struct mdp_irq_wait *wait =
0082             container_of(irq, struct mdp_irq_wait, irq);
0083     wait->count--;
0084     wake_up_all(&wait_event);
0085 }
0086
0087 void mdp_irq_wait(struct mdp_kms *mdp_kms, uint32_t irqmask)
0088 {
0089     struct mdp_irq_wait wait = {
0090         .irq = {
0091             .irq = wait_irq,
0092             .irqmask = irqmask,
0093         },
0094         .count = 1,
0095     };
0096     mdp_irq_register(mdp_kms, &wait.irq);
0097     wait_event_timeout(wait_event, (wait.count <= 0),
0098             msecs_to_jiffies(100));
0099     mdp_irq_unregister(mdp_kms, &wait.irq);
0100 }
0101
0102 void mdp_irq_register(struct mdp_kms *mdp_kms, struct mdp_irq *irq)
0103 {
0104     unsigned long flags;
0105     bool needs_update = false;
0106
0107     spin_lock_irqsave(&list_lock, flags);
0108
0109     if (!irq->registered) {
0110         irq->registered = true;
0111         list_add(&irq->node, &mdp_kms->irq_list);
0112         needs_update = !mdp_kms->in_irq;
0113     }
0114
0115     spin_unlock_irqrestore(&list_lock, flags);
0116
0117     if (needs_update)
0118         mdp_irq_update(mdp_kms);
0119 }
0120
0121 void mdp_irq_unregister(struct mdp_kms *mdp_kms, struct mdp_irq *irq)
0122 {
0123     unsigned long flags;
0124     bool needs_update = false;
0125
0126     spin_lock_irqsave(&list_lock, flags);
0127
0128     if (irq->registered) {
0129         irq->registered = false;
0130         list_del(&irq->node);
0131         needs_update = !mdp_kms->in_irq;
0132     }
0133
0134     spin_unlock_irqrestore(&list_lock, flags);
0135
0136     if (needs_update)
0137         mdp_irq_update(mdp_kms);
0138 }