root/kernel/irq/pm.c
// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (C) 2009 Rafael J. Wysocki <rjw@sisk.pl>, Novell Inc.
 *
 * This file contains power management functions related to interrupts.
 */

#include <linux/irq.h>
#include <linux/module.h>
#include <linux/interrupt.h>
#include <linux/suspend.h>
#include <linux/syscore_ops.h>

#include "internals.h"

void irq_pm_handle_wakeup(struct irq_desc *desc)
{
        irqd_clear(&desc->irq_data, IRQD_WAKEUP_ARMED);
        desc->istate |= IRQS_SUSPENDED | IRQS_PENDING;
        desc->depth++;
        irq_disable(desc);
        pm_system_irq_wakeup(irq_desc_get_irq(desc));
}

/*
 * Called from __setup_irq() with desc->lock held after @action has
 * been installed in the action chain.
 */
void irq_pm_install_action(struct irq_desc *desc, struct irqaction *action)
{
        desc->nr_actions++;

        if (action->flags & IRQF_FORCE_RESUME)
                desc->force_resume_depth++;

        WARN_ON_ONCE(desc->force_resume_depth &&
                     desc->force_resume_depth != desc->nr_actions);

        if (action->flags & IRQF_NO_SUSPEND)
                desc->no_suspend_depth++;
        else if (action->flags & IRQF_COND_SUSPEND)
                desc->cond_suspend_depth++;

        WARN_ON_ONCE(desc->no_suspend_depth &&
                     (desc->no_suspend_depth + desc->cond_suspend_depth) != desc->nr_actions);
}

/*
 * Called from __free_irq() with desc->lock held after @action has
 * been removed from the action chain.
 */
void irq_pm_remove_action(struct irq_desc *desc, struct irqaction *action)
{
        desc->nr_actions--;

        if (action->flags & IRQF_FORCE_RESUME)
                desc->force_resume_depth--;

        if (action->flags & IRQF_NO_SUSPEND)
                desc->no_suspend_depth--;
        else if (action->flags & IRQF_COND_SUSPEND)
                desc->cond_suspend_depth--;
}

static bool suspend_device_irq(struct irq_desc *desc)
{
        unsigned long chipflags = irq_desc_get_chip(desc)->flags;
        struct irq_data *irqd = &desc->irq_data;

        if (!desc->action || irq_desc_is_chained(desc) ||
            desc->no_suspend_depth)
                return false;

        if (irqd_is_wakeup_set(irqd)) {
                irqd_set(irqd, IRQD_WAKEUP_ARMED);

                if ((chipflags & IRQCHIP_ENABLE_WAKEUP_ON_SUSPEND) &&
                     irqd_irq_disabled(irqd)) {
                        /*
                         * Interrupt marked for wakeup is in disabled state.
                         * Enable interrupt here to unmask/enable in irqchip
                         * to be able to resume with such interrupts.
                         */
                        __enable_irq(desc);
                        irqd_set(irqd, IRQD_IRQ_ENABLED_ON_SUSPEND);
                }
                /*
                 * We return true here to force the caller to issue
                 * synchronize_irq(). We need to make sure that the
                 * IRQD_WAKEUP_ARMED is visible before we return from
                 * suspend_device_irqs().
                 */
                return true;
        }

        desc->istate |= IRQS_SUSPENDED;
        __disable_irq(desc);

        /*
         * Hardware which has no wakeup source configuration facility
         * requires that the non wakeup interrupts are masked at the
         * chip level. The chip implementation indicates that with
         * IRQCHIP_MASK_ON_SUSPEND.
         */
        if (chipflags & IRQCHIP_MASK_ON_SUSPEND)
                mask_irq(desc);
        return true;
}

/**
 * suspend_device_irqs - disable all currently enabled interrupt lines
 *
 * During system-wide suspend or hibernation device drivers need to be
 * prevented from receiving interrupts and this function is provided
 * for this purpose.
 *
 * So we disable all interrupts and mark them IRQS_SUSPENDED except
 * for those which are unused, those which are marked as not
 * suspendable via an interrupt request with the flag IRQF_NO_SUSPEND
 * set and those which are marked as active wakeup sources.
 *
 * The active wakeup sources are handled by the flow handler entry
 * code which checks for the IRQD_WAKEUP_ARMED flag, suspends the
 * interrupt and notifies the pm core about the wakeup.
 */
void suspend_device_irqs(void)
{
        struct irq_desc *desc;
        int irq;

        for_each_irq_desc(irq, desc) {
                bool sync;

                if (irq_settings_is_nested_thread(desc))
                        continue;
                scoped_guard(raw_spinlock_irqsave, &desc->lock)
                        sync = suspend_device_irq(desc);

                if (sync)
                        synchronize_irq(irq);
        }
}

static void resume_irq(struct irq_desc *desc)
{
        struct irq_data *irqd = &desc->irq_data;

        irqd_clear(irqd, IRQD_WAKEUP_ARMED);

        if (irqd_is_enabled_on_suspend(irqd)) {
                /*
                 * Interrupt marked for wakeup was enabled during suspend
                 * entry. Disable such interrupts to restore them back to
                 * original state.
                 */
                __disable_irq(desc);
                irqd_clear(irqd, IRQD_IRQ_ENABLED_ON_SUSPEND);
        }

        if (desc->istate & IRQS_SUSPENDED)
                goto resume;

        /* Force resume the interrupt? */
        if (!desc->force_resume_depth)
                return;

        /* Pretend that it got disabled ! */
        desc->depth++;
        irq_state_set_disabled(desc);
        irq_state_set_masked(desc);
resume:
        desc->istate &= ~IRQS_SUSPENDED;
        __enable_irq(desc);
}

static void resume_irqs(bool want_early)
{
        struct irq_desc *desc;
        int irq;

        for_each_irq_desc(irq, desc) {
                bool is_early = desc->action && desc->action->flags & IRQF_EARLY_RESUME;

                if (!is_early && want_early)
                        continue;
                if (irq_settings_is_nested_thread(desc))
                        continue;

                guard(raw_spinlock_irqsave)(&desc->lock);
                resume_irq(desc);
        }
}

/**
 * rearm_wake_irq - rearm a wakeup interrupt line after signaling wakeup
 * @irq: Interrupt to rearm
 */
void rearm_wake_irq(unsigned int irq)
{
        scoped_irqdesc_get_and_buslock(irq, IRQ_GET_DESC_CHECK_GLOBAL) {
                struct irq_desc *desc = scoped_irqdesc;

                if (!(desc->istate & IRQS_SUSPENDED) || !irqd_is_wakeup_set(&desc->irq_data))
                        return;

                desc->istate &= ~IRQS_SUSPENDED;
                irqd_set(&desc->irq_data, IRQD_WAKEUP_ARMED);
                __enable_irq(desc);
        }
}

/**
 * irq_pm_syscore_resume - enable interrupt lines early
 * @data: syscore context
 *
 * Enable all interrupt lines with %IRQF_EARLY_RESUME set.
 */
static void irq_pm_syscore_resume(void *data)
{
        resume_irqs(true);
}

static const struct syscore_ops irq_pm_syscore_ops = {
        .resume         = irq_pm_syscore_resume,
};

static struct syscore irq_pm_syscore = {
        .ops = &irq_pm_syscore_ops,
};

static int __init irq_pm_init_ops(void)
{
        register_syscore(&irq_pm_syscore);
        return 0;
}

device_initcall(irq_pm_init_ops);

/**
 * resume_device_irqs - enable interrupt lines disabled by suspend_device_irqs()
 *
 * Enable all non-%IRQF_EARLY_RESUME interrupt lines previously
 * disabled by suspend_device_irqs() that have the IRQS_SUSPENDED flag
 * set as well as those with %IRQF_FORCE_RESUME.
 */
void resume_device_irqs(void)
{
        resume_irqs(false);
}