cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

mdp_kms.c (3075B)

      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}