190 lines
4.4 KiB
C
190 lines
4.4 KiB
C
|
/*
|
||
|
* SPDX-License-Identifier: MIT
|
||
|
*
|
||
|
* Copyright © 2019 Intel Corporation
|
||
|
*/
|
||
|
|
||
|
#include <linux/wait_bit.h>
|
||
|
|
||
|
#include "intel_runtime_pm.h"
|
||
|
#include "intel_wakeref.h"
|
||
|
|
||
|
static void rpm_get(struct intel_wakeref *wf)
|
||
|
{
|
||
|
wf->wakeref = intel_runtime_pm_get(wf->rpm);
|
||
|
}
|
||
|
|
||
|
static void rpm_put(struct intel_wakeref *wf)
|
||
|
{
|
||
|
intel_wakeref_t wakeref = fetch_and_zero(&wf->wakeref);
|
||
|
|
||
|
intel_runtime_pm_put(wf->rpm, wakeref);
|
||
|
INTEL_WAKEREF_BUG_ON(!wakeref);
|
||
|
}
|
||
|
|
||
|
int __intel_wakeref_get_first(struct intel_wakeref *wf)
|
||
|
{
|
||
|
/*
|
||
|
* Treat get/put as different subclasses, as we may need to run
|
||
|
* the put callback from under the shrinker and do not want to
|
||
|
* cross-contanimate that callback with any extra work performed
|
||
|
* upon acquiring the wakeref.
|
||
|
*/
|
||
|
mutex_lock_nested(&wf->mutex, SINGLE_DEPTH_NESTING);
|
||
|
if (!atomic_read(&wf->count)) {
|
||
|
int err;
|
||
|
|
||
|
rpm_get(wf);
|
||
|
|
||
|
err = wf->ops->get(wf);
|
||
|
if (unlikely(err)) {
|
||
|
rpm_put(wf);
|
||
|
mutex_unlock(&wf->mutex);
|
||
|
return err;
|
||
|
}
|
||
|
|
||
|
smp_mb__before_atomic(); /* release wf->count */
|
||
|
}
|
||
|
atomic_inc(&wf->count);
|
||
|
mutex_unlock(&wf->mutex);
|
||
|
|
||
|
INTEL_WAKEREF_BUG_ON(atomic_read(&wf->count) <= 0);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void ____intel_wakeref_put_last(struct intel_wakeref *wf)
|
||
|
{
|
||
|
INTEL_WAKEREF_BUG_ON(atomic_read(&wf->count) <= 0);
|
||
|
if (unlikely(!atomic_dec_and_test(&wf->count)))
|
||
|
goto unlock;
|
||
|
|
||
|
/* ops->put() must reschedule its own release on error/deferral */
|
||
|
if (likely(!wf->ops->put(wf))) {
|
||
|
rpm_put(wf);
|
||
|
wake_up_var(&wf->wakeref);
|
||
|
}
|
||
|
|
||
|
unlock:
|
||
|
mutex_unlock(&wf->mutex);
|
||
|
}
|
||
|
|
||
|
void __intel_wakeref_put_last(struct intel_wakeref *wf, unsigned long flags)
|
||
|
{
|
||
|
INTEL_WAKEREF_BUG_ON(delayed_work_pending(&wf->work));
|
||
|
|
||
|
/* Assume we are not in process context and so cannot sleep. */
|
||
|
if (flags & INTEL_WAKEREF_PUT_ASYNC || !mutex_trylock(&wf->mutex)) {
|
||
|
mod_delayed_work(system_wq, &wf->work,
|
||
|
FIELD_GET(INTEL_WAKEREF_PUT_DELAY, flags));
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
____intel_wakeref_put_last(wf);
|
||
|
}
|
||
|
|
||
|
static void __intel_wakeref_put_work(struct work_struct *wrk)
|
||
|
{
|
||
|
struct intel_wakeref *wf = container_of(wrk, typeof(*wf), work.work);
|
||
|
|
||
|
if (atomic_add_unless(&wf->count, -1, 1))
|
||
|
return;
|
||
|
|
||
|
mutex_lock(&wf->mutex);
|
||
|
____intel_wakeref_put_last(wf);
|
||
|
}
|
||
|
|
||
|
void __intel_wakeref_init(struct intel_wakeref *wf,
|
||
|
struct intel_runtime_pm *rpm,
|
||
|
const struct intel_wakeref_ops *ops,
|
||
|
struct intel_wakeref_lockclass *key)
|
||
|
{
|
||
|
wf->rpm = rpm;
|
||
|
wf->ops = ops;
|
||
|
|
||
|
__mutex_init(&wf->mutex, "wakeref.mutex", &key->mutex);
|
||
|
atomic_set(&wf->count, 0);
|
||
|
wf->wakeref = 0;
|
||
|
|
||
|
INIT_DELAYED_WORK(&wf->work, __intel_wakeref_put_work);
|
||
|
lockdep_init_map(&wf->work.work.lockdep_map,
|
||
|
"wakeref.work", &key->work, 0);
|
||
|
}
|
||
|
|
||
|
int intel_wakeref_wait_for_idle(struct intel_wakeref *wf)
|
||
|
{
|
||
|
int err;
|
||
|
|
||
|
might_sleep();
|
||
|
|
||
|
err = wait_var_event_killable(&wf->wakeref,
|
||
|
!intel_wakeref_is_active(wf));
|
||
|
if (err)
|
||
|
return err;
|
||
|
|
||
|
intel_wakeref_unlock_wait(wf);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void wakeref_auto_timeout(struct timer_list *t)
|
||
|
{
|
||
|
struct intel_wakeref_auto *wf = from_timer(wf, t, timer);
|
||
|
intel_wakeref_t wakeref;
|
||
|
unsigned long flags;
|
||
|
|
||
|
if (!refcount_dec_and_lock_irqsave(&wf->count, &wf->lock, &flags))
|
||
|
return;
|
||
|
|
||
|
wakeref = fetch_and_zero(&wf->wakeref);
|
||
|
spin_unlock_irqrestore(&wf->lock, flags);
|
||
|
|
||
|
intel_runtime_pm_put(wf->rpm, wakeref);
|
||
|
}
|
||
|
|
||
|
void intel_wakeref_auto_init(struct intel_wakeref_auto *wf,
|
||
|
struct intel_runtime_pm *rpm)
|
||
|
{
|
||
|
spin_lock_init(&wf->lock);
|
||
|
timer_setup(&wf->timer, wakeref_auto_timeout, 0);
|
||
|
refcount_set(&wf->count, 0);
|
||
|
wf->wakeref = 0;
|
||
|
wf->rpm = rpm;
|
||
|
}
|
||
|
|
||
|
void intel_wakeref_auto(struct intel_wakeref_auto *wf, unsigned long timeout)
|
||
|
{
|
||
|
unsigned long flags;
|
||
|
|
||
|
if (!timeout) {
|
||
|
if (del_timer_sync(&wf->timer))
|
||
|
wakeref_auto_timeout(&wf->timer);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
/* Our mission is that we only extend an already active wakeref */
|
||
|
assert_rpm_wakelock_held(wf->rpm);
|
||
|
|
||
|
if (!refcount_inc_not_zero(&wf->count)) {
|
||
|
spin_lock_irqsave(&wf->lock, flags);
|
||
|
if (!refcount_inc_not_zero(&wf->count)) {
|
||
|
INTEL_WAKEREF_BUG_ON(wf->wakeref);
|
||
|
wf->wakeref = intel_runtime_pm_get_if_in_use(wf->rpm);
|
||
|
refcount_set(&wf->count, 1);
|
||
|
}
|
||
|
spin_unlock_irqrestore(&wf->lock, flags);
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* If we extend a pending timer, we will only get a single timer
|
||
|
* callback and so need to cancel the local inc by running the
|
||
|
* elided callback to keep the wf->count balanced.
|
||
|
*/
|
||
|
if (mod_timer(&wf->timer, jiffies + timeout))
|
||
|
wakeref_auto_timeout(&wf->timer);
|
||
|
}
|
||
|
|
||
|
void intel_wakeref_auto_fini(struct intel_wakeref_auto *wf)
|
||
|
{
|
||
|
intel_wakeref_auto(wf, 0);
|
||
|
INTEL_WAKEREF_BUG_ON(wf->wakeref);
|
||
|
}
|