From mboxrd@z Thu Jan 1 00:00:00 1970 Received: from mail-pf1-f174.google.com (mail-pf1-f174.google.com [209.85.210.174]) (using TLSv1.2 with cipher ECDHE-RSA-AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 63B84374178 for ; Thu, 30 Apr 2026 04:58:00 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=209.85.210.174 ARC-Seal:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1777525081; cv=none; b=MCTbRZNX/qVhA+oLcD0VfjLqISr3b0HoLkRmvUglSohYqP3Vdz1dOpZSxXmHkEfkWcb1MHj6R9KMzMOWqnRUjoSVf5zA6FHrvEZfgYkP7lOnx0ud7bgYON5X10uooYi30A6Uj5dTGm6BK6P5zxk6Wpx7DMXsbCl2EVGHkuWdIJ0= ARC-Message-Signature:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1777525081; c=relaxed/simple; bh=to6np16T64xFNAcW1qzYMMT0OV6KhI74RWJmQ3sA+pE=; h=From:To:Cc:Subject:Date:Message-ID:In-Reply-To:References: MIME-Version; b=ES498bv/SQN+OMF4SFmu352I+Ue2Lu3m/+/eySLeY6dF5UFCA3F4gsz9mlgj8WiJRU7H9ZadrOoVbsSxO72UzFkwtB8SzchzDWuZOyN56vBs090IaTzSzSIV7uwXGDfBhjK9YS4qqx12SMD5DK5Z+dncjsLSfhsJ54h9zVUg0/I= ARC-Authentication-Results:i=1; smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=morsemicro.com; spf=pass smtp.mailfrom=morsemicro.com; dkim=pass (2048-bit key) header.d=morsemicro-com.20251104.gappssmtp.com header.i=@morsemicro-com.20251104.gappssmtp.com header.b=Qu8Bha1j; arc=none smtp.client-ip=209.85.210.174 Authentication-Results: smtp.subspace.kernel.org; dmarc=pass (p=none dis=none) header.from=morsemicro.com Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=morsemicro.com Authentication-Results: smtp.subspace.kernel.org; dkim=pass (2048-bit key) header.d=morsemicro-com.20251104.gappssmtp.com header.i=@morsemicro-com.20251104.gappssmtp.com header.b="Qu8Bha1j" Received: by mail-pf1-f174.google.com with SMTP id d2e1a72fcca58-82748257f5fso1187137b3a.1 for ; Wed, 29 Apr 2026 21:58:00 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=morsemicro-com.20251104.gappssmtp.com; s=20251104; t=1777525080; x=1778129880; darn=vger.kernel.org; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:from:to:cc:subject:date :message-id:reply-to; bh=c8Yt3MQQ7QZZcK6xo+vjOf0BGbRsje849ZFwtZL+Kfg=; b=Qu8Bha1jp6bI+lGreu5u/S9MxQx00jIY9Jbs6DJLVW/c7ZuptQP4a8629zIgqt/rRO UyEZbTe+IT+9tcvyZj/ThQFCachiJHnxyLIyqmF0LcG7JIKfmcNPNAdVSnPpS+a5D4JT w10RigKAWkED1/S+ovv9sr8LR+WZzZrFbVGBvW6FiDyMTjGfiUzIv5oR3w4SCKYWTGwe b2VgKn4ifFJwGTUrCFoX4Gw85jxmTc0rMSXLsT3pFTahoVLyuPcebTE/ziccL+QNJqLO ur41mRDHRQYp9F0VMYYngsyuNsnMJtjvRaqwVE5CEQXnMw4oHbJ+5oDE851WE8ymEZ95 jRUQ== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20251104; t=1777525080; x=1778129880; h=content-transfer-encoding:mime-version:references:in-reply-to :message-id:date:subject:cc:to:from:x-gm-gg:x-gm-message-state:from :to:cc:subject:date:message-id:reply-to; bh=c8Yt3MQQ7QZZcK6xo+vjOf0BGbRsje849ZFwtZL+Kfg=; b=TkM3395YSRmJ41Mp078UkaROB01XJjx/7UGbZleq4wGswGc/1lJO8/slj/iOduT+CA H75MFWQ0yiMWpmce/qYCjnj3/T6Df5cZTSRF8iJy5WREp1henwxH9ereMawGJ7jlT58j GA8rXFT9MpT4z0vvXsk2jSwlqTR1YIgWLztL3hsWs5+zT0hezK0sGs5J2ZrD5CkNspYV TWIHL1bO0z+jRYXQ0yol7fjuR3FOO/JI8CdtZIRIHYYFtopT17qokEgHZIkirVF4rqsZ dHC+McWAXSpWdRmnloRPtZMR60KcB1TWqnogUgIsZgf28bi0IWdMv3phdBpcJS7pm6b8 7v/Q== X-Forwarded-Encrypted: i=1; AFNElJ96mPVZIF4YkijAVcsTFISJGn9TctMGiohNVwNs9iqB+KnX1MlelAJOSxAW4+86kGdGBQlvynqfnNkrBJg=@vger.kernel.org X-Gm-Message-State: AOJu0YxZ1C30VfBbBdRtw2e8AygjzF+L6ov/FUAt2ApHdCQpCvNlQkGy prTqLHT6IBNFgo3+noIgFuknBALL4gTcW1bxTalEVc0iYGTFujiVtyUdN9ESKe+UtkQ= X-Gm-Gg: AeBDieutTwDPPj9HfhGeYpSvWQ5PSB2FB/tXZmNzk53RfNg5eilhvtHwbh09Rb9KwI3 gygDIf6Rq8cazdI3AuIsvNUxbmngfT3fn9MXobfMLxPzSEtUSVqhzWlUs+2iF7sgUGLifVAlbrD X14LPqzKg+BksgDm7Zlhbf61AsrltQBtUpSAckpr7y3E2rRWU0QC2QRQdsC3DqTrB1//UjEEd/Y 22L+USYlMOgqVAw6HgoBsHe9knG0QkSV+1HTJSoAEeEChMHv37mYorIaGFXUYnT87ygkkz0idFW LtfRjZ31UdgxU8RcYsMzXjEY2R5hBIZBshMp13w/X7zvLOYGWM1+/RTZcEjorfqqaljF58B98uf z3HIO3SNGF6d6LLGfTb7j1+CUoFptwtD7MrgdLP9bWyuuXOwUile8O/FBgXajsosNuPvEHJca83 RITAnEiy1MJoqe97N9nCY89nYK2H12jq3FDgasSJ1KYi3v5U9yuJwVOKqmIrjuo1GANmvDdiFpF mOiiHq1HihTdC7YSfKk9iCie04Jj9xuJn4ec95iFQ== X-Received: by 2002:a05:6a00:94c2:b0:82f:47ec:944f with SMTP id d2e1a72fcca58-8350014a465mr1043309b3a.16.1777525079848; Wed, 29 Apr 2026 21:57:59 -0700 (PDT) Received: from mma-H9MHD44.lan (60-242-93-14.static.tpgi.com.au. [60.242.93.14]) by smtp.gmail.com with ESMTPSA id d2e1a72fcca58-834ed80df96sm3595073b3a.54.2026.04.29.21.57.55 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Wed, 29 Apr 2026 21:57:59 -0700 (PDT) From: Lachlan Hodges To: johannes@sipsolutions.net, Lachlan Hodges , Dan Callaghan , Arien Judge Cc: ayman.grais@morsemicro.com, linux-wireless@vger.kernel.org, linux-kernel@vger.kernel.org Subject: [PATCH wireless-next v2 16/31] wifi: mm81x: add ps.c Date: Thu, 30 Apr 2026 14:55:42 +1000 Message-ID: <20260430045615.334669-17-lachlan.hodges@morsemicro.com> X-Mailer: git-send-email 2.43.0 In-Reply-To: <20260430045615.334669-1-lachlan.hodges@morsemicro.com> References: <20260430045615.334669-1-lachlan.hodges@morsemicro.com> Precedence: bulk X-Mailing-List: linux-kernel@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Transfer-Encoding: 8bit (Patches split per file for review, will be a single commit alongside SDIO ids once review is complete. See cover letter for more information) Signed-off-by: Lachlan Hodges --- drivers/net/wireless/morsemicro/mm81x/ps.c | 120 +++++++++++++++++++++ 1 file changed, 120 insertions(+) create mode 100644 drivers/net/wireless/morsemicro/mm81x/ps.c diff --git a/drivers/net/wireless/morsemicro/mm81x/ps.c b/drivers/net/wireless/morsemicro/mm81x/ps.c new file mode 100644 index 000000000000..ab67823452ee --- /dev/null +++ b/drivers/net/wireless/morsemicro/mm81x/ps.c @@ -0,0 +1,120 @@ +// SPDX-License-Identifier: GPL-2.0-only +/* + * Copyright (c) 2017-2026 Morse Micro + */ +#include +#include +#include +#include "hif.h" +#include "skbq.h" +#include "mac.h" +#include "bus.h" +#include "ps.h" + +static void mm81x_ps_wakeup(struct mm81x_ps *mps) +{ + struct mm81x *mors = container_of(mps, struct mm81x, ps); + + if (!mps->enable || !mps->suspended) + return; + + mm81x_set_bus_enable(mors, true); + mps->suspended = false; +} + +static void mm81x_ps_sleep(struct mm81x_ps *mps) +{ + struct mm81x *mors = container_of(mps, struct mm81x, ps); + + if (!mps->enable || mps->suspended) + return; + + mps->suspended = true; + mm81x_set_bus_enable(mors, false); +} + +static void mm81x_ps_evaluate(struct mm81x_ps *mps) +{ + struct mm81x *mors = container_of(mps, struct mm81x, ps); + bool needs_wake = false; + unsigned long flags_on_entry = + (mors->hif.event_flags & + ~BIT(MM81X_HIF_EVT_DATA_TRAFFIC_PAUSE_PEND)); + + if (!mps->enable) + return; + + needs_wake = (mps->wakers > 0); + needs_wake |= (flags_on_entry > 0); + needs_wake |= (mm81x_hif_get_tx_buffered_count(mors) > 0); + + if (needs_wake) { + mm81x_ps_wakeup(mps); + return; + } + + mm81x_ps_sleep(mps); +} + +static void mm81x_ps_evaluate_work(struct work_struct *work) +{ + struct mm81x_ps *mps = + container_of(work, struct mm81x_ps, delayed_eval_work.work); + + if (mps->enable) { + mutex_lock(&mps->lock); + mm81x_ps_evaluate(mps); + mutex_unlock(&mps->lock); + } +} + +void mm81x_ps_enable(struct mm81x *mors) +{ + struct mm81x_ps *mps = &mors->ps; + + if (mps->enable) { + mutex_lock(&mps->lock); + if (mps->wakers == 0) { + WARN_ON_ONCE(1); + } else { + mps->wakers--; + mm81x_ps_evaluate(mps); + } + mutex_unlock(&mps->lock); + } +} + +void mm81x_ps_disable(struct mm81x *mors) +{ + struct mm81x_ps *mps = &mors->ps; + + if (mps->enable) { + mutex_lock(&mps->lock); + mps->wakers++; + mm81x_ps_evaluate(mps); + mutex_unlock(&mps->lock); + } +} + +int mm81x_ps_init(struct mm81x *mors) +{ + struct mm81x_ps *mps = &mors->ps; + + mps->enable = (mors->bus_type == MM81X_BUS_TYPE_USB); + mps->suspended = true; + mps->wakers = 1; /* we default to being on */ + mutex_init(&mps->lock); + INIT_DELAYED_WORK(&mps->delayed_eval_work, mm81x_ps_evaluate_work); + + return 0; +} + +void mm81x_ps_finish(struct mm81x *mors) +{ + struct mm81x_ps *mps = &mors->ps; + + if (mps->enable) { + mps->enable = false; + cancel_delayed_work_sync(&mps->delayed_eval_work); + } +} -- 2.43.0