From patchwork Mon Sep 18 02:46:05 2023 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 8bit X-Patchwork-Submitter: Chaoyong He X-Patchwork-Id: 131553 X-Patchwork-Delegate: ferruh.yigit@amd.com Return-Path: X-Original-To: patchwork@inbox.dpdk.org Delivered-To: patchwork@inbox.dpdk.org Received: from mails.dpdk.org (mails.dpdk.org [217.70.189.124]) by inbox.dpdk.org (Postfix) with ESMTP id 4FAF1425C9; Mon, 18 Sep 2023 04:49:44 +0200 (CEST) Received: from mails.dpdk.org (localhost [127.0.0.1]) by mails.dpdk.org (Postfix) with ESMTP id 887E742D0B; Mon, 18 Sep 2023 04:47:50 +0200 (CEST) Received: from NAM12-MW2-obe.outbound.protection.outlook.com (mail-mw2nam12on2099.outbound.protection.outlook.com [40.107.244.99]) by mails.dpdk.org (Postfix) with ESMTP id ED769411F3 for ; Mon, 18 Sep 2023 04:47:45 +0200 (CEST) ARC-Seal: i=1; a=rsa-sha256; s=arcselector9901; d=microsoft.com; cv=none; b=imK2DEWWW8n6RDHXp5qz4+f2vgPWFThOH1b4eJHIUv7fRXbYjaVCHf/0ZkFL9/Mqa89TTRFYhjILjhxaWHaYuw5/UGg0zqonCMOAxqEtHYoj/qLplDAmAtgVOr6kGor724HIoxeYAtjwrnuOIVVcy9WQ91y4t9vC5dd8k995FcG9M9PlaIsl7GWdn5FbkSZT5ScEKoWBZst/1QdoKXGx+ZyQ6ElVjxYKB6xuQDw5EpXi+NAN7n+wWE2Bn28b4qpdC6u+lkAvtg2r0f17jd2GtmkgIc9xxLjeaDH8+TIFz+eXM0zTaTjhCymUVkuXSU1QUZIeLOJarLK+zDPoZFCyjg== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=microsoft.com; s=arcselector9901; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-AntiSpam-MessageData-ChunkCount:X-MS-Exchange-AntiSpam-MessageData-0:X-MS-Exchange-AntiSpam-MessageData-1; bh=IOgFsqfvnNLZXXFbICi/bw9LVDspv51m0afbB0POPSw=; b=mbWQqwEZSeYyc7yvRhNb66khNmQE3r6G7T7tq9ftDrYO5POkjb4QXmSWkB2+yvsqI+V/halrrwToUmuD/9XPi5fLBbWf9t52BC38oBgy3Sho+2Dw09Zd03/VIaJZ9pQfMv1IChG5B490ZKglROV4dXkErDIck0SEatCFr7CnXlnxgKC3o4YMS3aHVgIs4gktvzcn1TrUYIPxflTNJ9TwvLj6jyYjuMYKnDRiuRpa1v7iSIfMOnteorubDKRBVFIvK2YHxRrwnZ3Soobx0Zyg2zcu8Kc6iP9bB5jJcHKuj3ojLdEoOmk/bdqei+akt4MIf/IBa96MtXEp9xZuTXCfdg== ARC-Authentication-Results: i=1; mx.microsoft.com 1; spf=pass smtp.mailfrom=corigine.com; dmarc=pass action=none header.from=corigine.com; dkim=pass header.d=corigine.com; arc=none DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=corigine.onmicrosoft.com; s=selector2-corigine-onmicrosoft-com; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=IOgFsqfvnNLZXXFbICi/bw9LVDspv51m0afbB0POPSw=; b=RiLGEwyt58bDfZq6bGi2bhTgaxyS1BH5KKwmIV3nMvZXnFBjrgXnYfXY5WJLrdlhpvH5RGJ23P6DAdH0emofwptVwpgt9nF1Q5j/5iCg22kWBgod1H5KE69Z3Y0BP3wkmfs1MgNxxTET8zw2cyJC7u/ZexoUwyXdF9I9orbQL10= Authentication-Results: dkim=none (message not signed) header.d=none;dmarc=none action=none header.from=corigine.com; Received: from SJ0PR13MB5545.namprd13.prod.outlook.com (2603:10b6:a03:424::5) by PH7PR13MB6435.namprd13.prod.outlook.com (2603:10b6:510:2ea::9) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.6792.26; Mon, 18 Sep 2023 02:47:44 +0000 Received: from SJ0PR13MB5545.namprd13.prod.outlook.com ([fe80::7a1c:2887:348a:84bd]) by SJ0PR13MB5545.namprd13.prod.outlook.com ([fe80::7a1c:2887:348a:84bd%6]) with mapi id 15.20.6792.026; Mon, 18 Sep 2023 02:47:44 +0000 From: Chaoyong He To: dev@dpdk.org Cc: Chaoyong He , =?utf-8?q?Niklas_S=C3=B6derlund?= Subject: [PATCH v4 19/26] net/nfp: refact the mutex module Date: Mon, 18 Sep 2023 10:46:05 +0800 Message-Id: <20230918024612.1600536-20-chaoyong.he@corigine.com> X-Mailer: git-send-email 2.39.1 In-Reply-To: <20230918024612.1600536-1-chaoyong.he@corigine.com> References: <20230915091551.1459606-1-chaoyong.he@corigine.com> <20230918024612.1600536-1-chaoyong.he@corigine.com> X-ClientProxiedBy: SE2P216CA0016.KORP216.PROD.OUTLOOK.COM (2603:1096:101:114::20) To SJ0PR13MB5545.namprd13.prod.outlook.com (2603:10b6:a03:424::5) MIME-Version: 1.0 X-MS-PublicTrafficType: Email X-MS-TrafficTypeDiagnostic: SJ0PR13MB5545:EE_|PH7PR13MB6435:EE_ X-MS-Office365-Filtering-Correlation-Id: 66483759-805f-4517-85a3-08dbb7f1a24c X-MS-Exchange-SenderADCheck: 1 X-MS-Exchange-AntiSpam-Relay: 0 X-Microsoft-Antispam: BCL:0; X-Microsoft-Antispam-Message-Info: HsENdSNSv+tTFvoOtVSzAsZvv3galwCfx+muQ/L1Aex4kdvMZdzDM+xA/U/fDrS2BvDcfZCMmtHWnhs4IcWNDTTwGCBlpRaonHT+/J5Il9twu1lml+BbjKQMaMxsljl4TfsnuFdB4i5O8IrG/ch6ZibKng/xGeBMIFhC6Ie1Pqu4EcwFnLWe6RjK/05hMc8ynLKNSS2QGKPvvS8xnFCKaXVcb1W81szWDvYRgg49Xcuoxy1PtM/LMuFezAcFI7GZjLg1/XY2hcAAiPlzdpR8LxTIPA8Yl9ROZgrTzznTMEb50u3tpsg3i3/AekxNyM9Xy9RbnmWSmQas7FQNBWeezert3sN++g7+ecKc40+O/j8aHtUZQXLCYy+++p1S4Gtwq+Y2w2xSE11pBGQKlBZCwVhFuUikohoNKPfYQOO2Atxy7j7tHU2IflTXE7n1VQXtMpcNxsRUtukquMrthTZzDAiQ6FBJBSkd+6agouEk8ypI9iicd2/sI1zOd42mnkqUTeWqOnY48JVX5+EBVgqFh9R7wiK4EIadinhwAF3gVHbEpyY40kJvX4i9lyn0T/Vjji9xlh1w5Vgd1pdcWp8kpEVUIuc+yWYakXz2RG42L1xtwSYr93zQYdg9y0Dv2FT5WUHdRZ+vTeqTdNV0Crz74TUPCOhMOK0A77MS5TmW3kU= X-Forefront-Antispam-Report: CIP:255.255.255.255; CTRY:; LANG:en; SCL:1; SRV:; IPV:NLI; SFV:NSPM; H:SJ0PR13MB5545.namprd13.prod.outlook.com; PTR:; CAT:NONE; SFS:(13230031)(39830400003)(136003)(346002)(366004)(376002)(396003)(1800799009)(451199024)(186009)(54906003)(66476007)(66946007)(66574015)(41300700001)(6916009)(316002)(8676002)(4326008)(8936002)(52116002)(6506007)(6486002)(6512007)(478600001)(6666004)(83380400001)(26005)(1076003)(2616005)(107886003)(86362001)(2906002)(30864003)(44832011)(38100700002)(38350700002)(5660300002)(36756003)(66556008); DIR:OUT; SFP:1102; X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1 X-MS-Exchange-AntiSpam-MessageData-0: =?utf-8?q?8e5abojoqfrUAwh5Fx2pK3ReQWDo?= =?utf-8?q?TUS6VGXfBvZ0380YeVMRnIsjRlUmSZb0yOjSYecee+aw1Pj3FPENyL2HJ9Rz4LXpA?= =?utf-8?q?OOz3xq110TDDcz/oOD2dOpc8qQkIYr3hvvHLqI9EI+OL/CyphREQ3UcPepUHk6cP5?= =?utf-8?q?KIQ8xPxu5/iy1zCW0LzflPHulAQamgKctZ9/bx1YoNtgYm4lhgiWSTnga+1M4i+56?= =?utf-8?q?kuW/v9em59jvf6IS+238B17sk0jWZ0eL/GdAUq7cekEA8ov68/9TDkvu15VFs2/dd?= =?utf-8?q?+17TMzV2rkyMw4P9T/cI0/DcSyDtsnO40uTBGzna4b5F208ivaiYoDfgnE1wQeIJ2?= =?utf-8?q?iYE1zkLomPTWSbhWExfLhVyit5j7BJjqYwQqCQzdTg7OojdDEwxxVW7WD8CXj3LNh?= =?utf-8?q?nlewZxeQj1bry/XgQf/SGJWN8R/qkUWAOJvha99v7g0M+ykGLW639qLmwtZt0Pb/h?= =?utf-8?q?GemKP+8loeOC66LaNTQmUEBuu1PVPaBNxBQ8QGiseLg4pvF1efYQ8rqaGXd7/cJxt?= =?utf-8?q?8AiUrlxBS58WsgqxYpkofI+HwJ/rZRvJLyoV6flbL074NagR/tzBKd5E/ZXFBi6D0?= =?utf-8?q?DD4VafrVtA+yyabwa4fwRl/9jrhWS0TMW3TagmbfFDAgxRu5UIvYG1+0rJskxpUMy?= =?utf-8?q?SEd+D6H3rJlQIE8/4NIgr28Ma/bmagcVfJ99OBPfwvbnKle0JlWLvu1OecQCGSiva?= =?utf-8?q?fYd0/hDJMRU2S1o99a8QpdlRqHw/6lWjoh/NSTv+lGdirKXEZgfPdSORrOiAlIY3n?= =?utf-8?q?5jWexzcI+CVN8O5dAs9osnFlu94YQ/v6w407e9jqjDS6pKsjYWqk/c0XJ7z7HhpqJ?= =?utf-8?q?JiZwzRqxe8QkyE0oUFaOWagn8YE4D+VHSOsfhxptSuamZbptBwmNpY60fVIl4F5sD?= =?utf-8?q?qAaG3G55lBs6Z2F1WxYkqpfuXg3/en3bgfRQNlqio/AVW5w62tEAYfEIGxGTodbKs?= =?utf-8?q?hMNcLjhApxQ7A30PVIqa02TWQqZ6/IRjlYKXqiGIaCpHyThD1C60zP4+oNiskiZsL?= =?utf-8?q?N4SCQDlXzl/qsGQTRY7c7LAd+YsI/uOqrdE11dZBZ4nFbVBgDMdb2cHmMrG6+wVHg?= =?utf-8?q?weYqIE8LojH/9mmtC67Q6jeiB65JvHSwNWBmJzWWn7dQP4Q0hBySbiTCzcv8NpIYe?= =?utf-8?q?EWRkAmQ+HZRBFrNNjx8ofZh2PTt0I5iTBpBo3gDo2TUqB3LV4WocsUMbOgAwYh9p9?= =?utf-8?q?4fEE1BHBIcKvMHbHYVLEVWiJ/xWuiJTX3GnNrOf5f8Rb4mY4aWpyOGDzPj27jjZFY?= =?utf-8?q?Qx6kt9oWdPyM1rOwzczR91PbESgYZxVNBvG7ngOzu15ZGMApjrxluGmbbRJqIn4On?= =?utf-8?q?g1plTbzG8JwwAARihCkqHRGvtkU5mmomnc/52IE4x21jYZsWXe2bNISmx8A5s846A?= =?utf-8?q?4z7YRYsCE4qxBY0qFH9ey8gwLHkGK6vMp8Iu2UKoBvVJOT5Oyq/HntCm/dSOivZqT?= =?utf-8?q?sk/9VoAEKVAZlYrLEFnum/KM41/1ODlVFg9jo0YCVcEMGYFzYNxyHTO+v6X7LZ4+3?= =?utf-8?q?xaeClahPsT0DMHY1pnHNOm9fdILIX4l86w=3D=3D?= X-OriginatorOrg: corigine.com X-MS-Exchange-CrossTenant-Network-Message-Id: 66483759-805f-4517-85a3-08dbb7f1a24c X-MS-Exchange-CrossTenant-AuthSource: SJ0PR13MB5545.namprd13.prod.outlook.com X-MS-Exchange-CrossTenant-AuthAs: Internal X-MS-Exchange-CrossTenant-OriginalArrivalTime: 18 Sep 2023 02:47:44.3620 (UTC) X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted X-MS-Exchange-CrossTenant-Id: fe128f2c-073b-4c20-818e-7246a585940c X-MS-Exchange-CrossTenant-MailboxType: HOSTED X-MS-Exchange-CrossTenant-UserPrincipalName: /rfJngMqtrexpmSpZ1rUTdGfouzq0sHnWtnZpPE27ZdlsKEPLmy6BfB/lAJkVq328VOCtO2X0MO3goIsJrRa2ehn6PArw/t8KIZZYTSu0mw= X-MS-Exchange-Transport-CrossTenantHeadersStamped: PH7PR13MB6435 X-BeenThere: dev@dpdk.org X-Mailman-Version: 2.1.29 Precedence: list List-Id: DPDK patches and discussions List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Errors-To: dev-bounces@dpdk.org Add a header file to holds the API declarations of this module. Also sync the logic from kernel driver and remove the unneeded header file include statements. Signed-off-by: Chaoyong He Reviewed-by: Niklas Söderlund --- drivers/net/nfp/nfpcore/nfp_cpp.h | 16 -- drivers/net/nfp/nfpcore/nfp_mutex.c | 205 ++++++++++++++----------- drivers/net/nfp/nfpcore/nfp_mutex.h | 25 +++ drivers/net/nfp/nfpcore/nfp_resource.c | 1 + 4 files changed, 138 insertions(+), 109 deletions(-) create mode 100644 drivers/net/nfp/nfpcore/nfp_mutex.h diff --git a/drivers/net/nfp/nfpcore/nfp_cpp.h b/drivers/net/nfp/nfpcore/nfp_cpp.h index be7ae1d919..42c4df5fdd 100644 --- a/drivers/net/nfp/nfpcore/nfp_cpp.h +++ b/drivers/net/nfp/nfpcore/nfp_cpp.h @@ -8,8 +8,6 @@ #include -struct nfp_cpp_mutex; - /* NFP CPP handle */ struct nfp_cpp { uint32_t model; @@ -426,20 +424,6 @@ int nfp_cpp_readq(struct nfp_cpp *cpp, uint32_t cpp_id, int nfp_cpp_writeq(struct nfp_cpp *cpp, uint32_t cpp_id, uint64_t address, uint64_t value); -int nfp_cpp_mutex_init(struct nfp_cpp *cpp, int target, - uint64_t address, uint32_t key_id); - -struct nfp_cpp_mutex *nfp_cpp_mutex_alloc(struct nfp_cpp *cpp, int target, - uint64_t address, uint32_t key_id); - -void nfp_cpp_mutex_free(struct nfp_cpp_mutex *mutex); - -int nfp_cpp_mutex_lock(struct nfp_cpp_mutex *mutex); - -int nfp_cpp_mutex_unlock(struct nfp_cpp_mutex *mutex); - -int nfp_cpp_mutex_trylock(struct nfp_cpp_mutex *mutex); - uint32_t nfp_cpp_mu_locality_lsb(struct nfp_cpp *cpp); #endif /* __NFP_CPP_H__ */ diff --git a/drivers/net/nfp/nfpcore/nfp_mutex.c b/drivers/net/nfp/nfpcore/nfp_mutex.c index 96ba60697c..3c10c7a090 100644 --- a/drivers/net/nfp/nfpcore/nfp_mutex.c +++ b/drivers/net/nfp/nfpcore/nfp_mutex.c @@ -3,21 +3,13 @@ * All rights reserved. */ -#include -#include +#include "nfp_mutex.h" + #include -#include "nfp_cpp.h" #include "nfp_logs.h" #include "nfp_target.h" -#define MUTEX_LOCKED(interface) ((((uint32_t)(interface)) << 16) | 0x000f) -#define MUTEX_UNLOCK(interface) (0 | 0x0000) - -#define MUTEX_IS_LOCKED(value) (((value) & 0xffff) == 0x000f) -#define MUTEX_IS_UNLOCKED(value) (((value) & 0xffff) == 0x0000) -#define MUTEX_INTERFACE(value) (((value) >> 16) & 0xffff) - /* * If you need more than 65536 recursive locks, please * rethink your code. @@ -34,21 +26,51 @@ struct nfp_cpp_mutex { struct nfp_cpp_mutex *prev, *next; }; +static inline uint32_t +nfp_mutex_locked(uint16_t interface) +{ + return (uint32_t)interface << 16 | 0x000f; +} + +static inline uint32_t +nfp_mutex_unlocked(uint16_t interface) +{ + return (uint32_t)interface << 16 | 0x0000; +} + +static inline uint16_t +nfp_mutex_owner(uint32_t val) +{ + return (val >> 16) & 0xffff; +} + +static inline bool +nfp_mutex_is_locked(uint32_t val) +{ + return (val & 0xffff) == 0x000f; +} + +static inline bool +nfp_mutex_is_unlocked(uint32_t val) +{ + return (val & 0xffff) == 0; +} + static int -nfp_cpp_mutex_validate(uint32_t model, +nfp_cpp_mutex_validate(uint16_t interface, int *target, uint64_t address) { + /* Not permitted on invalid interfaces */ + if (NFP_CPP_INTERFACE_TYPE_of(interface) == NFP_CPP_INTERFACE_TYPE_INVALID) + return -EINVAL; + /* Address must be 64-bit aligned */ if ((address & 7) != 0) return -EINVAL; - if (NFP_CPP_MODEL_IS_6000(model)) { - if (*target != NFP_CPP_TARGET_MU) - return -EINVAL; - } else { + if (*target != NFP_CPP_TARGET_MU) return -EINVAL; - } return 0; } @@ -84,10 +106,10 @@ nfp_cpp_mutex_init(struct nfp_cpp *cpp, uint32_t key) { int err; - uint32_t model = nfp_cpp_model(cpp); uint32_t muw = NFP_CPP_ID(target, 4, 0); /* atomic_write */ + uint16_t interface = nfp_cpp_interface(cpp); - err = nfp_cpp_mutex_validate(model, &target, address); + err = nfp_cpp_mutex_validate(interface, &target, address); if (err < 0) return err; @@ -95,8 +117,7 @@ nfp_cpp_mutex_init(struct nfp_cpp *cpp, if (err < 0) return err; - err = nfp_cpp_writel(cpp, muw, address + 0, - MUTEX_LOCKED(nfp_cpp_interface(cpp))); + err = nfp_cpp_writel(cpp, muw, address, nfp_mutex_locked(interface)); if (err < 0) return err; @@ -133,26 +154,10 @@ nfp_cpp_mutex_alloc(struct nfp_cpp *cpp, int err; uint32_t tmp; struct nfp_cpp_mutex *mutex; - uint32_t model = nfp_cpp_model(cpp); uint32_t mur = NFP_CPP_ID(target, 3, 0); /* atomic_read */ + uint16_t interface = nfp_cpp_interface(cpp); - /* Look for cached mutex */ - for (mutex = cpp->mutex_cache; mutex; mutex = mutex->next) { - if (mutex->target == target && mutex->address == address) - break; - } - - if (mutex) { - if (mutex->key == key) { - mutex->usage++; - return mutex; - } - - /* If the key doesn't match... */ - return NULL; - } - - err = nfp_cpp_mutex_validate(model, &target, address); + err = nfp_cpp_mutex_validate(interface, &target, address); if (err < 0) return NULL; @@ -172,16 +177,6 @@ nfp_cpp_mutex_alloc(struct nfp_cpp *cpp, mutex->address = address; mutex->key = key; mutex->depth = 0; - mutex->usage = 1; - - /* Add mutex to the cache */ - if (cpp->mutex_cache) { - cpp->mutex_cache->prev = mutex; - mutex->next = cpp->mutex_cache; - cpp->mutex_cache = mutex; - } else { - cpp->mutex_cache = mutex; - } return mutex; } @@ -195,20 +190,6 @@ nfp_cpp_mutex_alloc(struct nfp_cpp *cpp, void nfp_cpp_mutex_free(struct nfp_cpp_mutex *mutex) { - mutex->usage--; - if (mutex->usage > 0) - return; - - /* Remove mutex from the cache */ - if (mutex->next) - mutex->next->prev = mutex->prev; - if (mutex->prev) - mutex->prev->next = mutex->next; - - /* If mutex->cpp == NULL, something broke */ - if (mutex->cpp && mutex == mutex->cpp->mutex_cache) - mutex->cpp->mutex_cache = mutex->next; - free(mutex); } @@ -268,32 +249,28 @@ nfp_cpp_mutex_unlock(struct nfp_cpp_mutex *mutex) return 0; } - err = nfp_cpp_readl(mutex->cpp, mur, mutex->address, &value); - if (err < 0) - goto exit; - err = nfp_cpp_readl(mutex->cpp, mur, mutex->address + 4, &key); if (err < 0) - goto exit; + return err; - if (key != mutex->key) { - err = -EPERM; - goto exit; - } + if (key != mutex->key) + return -EPERM; - if (value != MUTEX_LOCKED(interface)) { - err = -EACCES; - goto exit; - } + err = nfp_cpp_readl(mutex->cpp, mur, mutex->address, &value); + if (err < 0) + return err; + + if (value != nfp_mutex_locked(interface)) + return -EACCES; - err = nfp_cpp_writel(cpp, muw, mutex->address, MUTEX_UNLOCK(interface)); + err = nfp_cpp_writel(cpp, muw, mutex->address, + nfp_mutex_unlocked(interface)); if (err < 0) - goto exit; + return err; mutex->depth = 0; -exit: - return err; + return 0; } /** @@ -332,19 +309,17 @@ nfp_cpp_mutex_trylock(struct nfp_cpp_mutex *mutex) /* Verify that the lock marker is not damaged */ err = nfp_cpp_readl(cpp, mur, mutex->address + 4, &key); if (err < 0) - goto exit; + return err; - if (key != mutex->key) { - err = -EPERM; - goto exit; - } + if (key != mutex->key) + return -EPERM; /* * Compare against the unlocked state, and if true, * write the interface id into the top 16 bits, and * mark as locked. */ - value = MUTEX_LOCKED(nfp_cpp_interface(cpp)); + value = nfp_mutex_locked(nfp_cpp_interface(cpp)); /* * We use test_set_imm here, as it implies a read @@ -361,10 +336,10 @@ nfp_cpp_mutex_trylock(struct nfp_cpp_mutex *mutex) */ err = nfp_cpp_readl(cpp, mus, mutex->address, &tmp); if (err < 0) - goto exit; + return err; /* Was it unlocked? */ - if (MUTEX_IS_UNLOCKED(tmp)) { + if (nfp_mutex_is_unlocked(tmp)) { /* * The read value can only be 0x....0000 in the unlocked state. * If there was another contending for this lock, then @@ -376,20 +351,64 @@ nfp_cpp_mutex_trylock(struct nfp_cpp_mutex *mutex) */ err = nfp_cpp_writel(cpp, muw, mutex->address, value); if (err < 0) - goto exit; + return err; mutex->depth = 1; - goto exit; + return 0; } /* Already locked by us? Success! */ if (tmp == value) { mutex->depth = 1; - goto exit; + return 0; } - err = MUTEX_IS_LOCKED(tmp) ? -EBUSY : -EINVAL; + return nfp_mutex_is_locked(tmp) ? -EBUSY : -EINVAL; +} + +/** + * Release lock if held by local system. + * Extreme care is advised, call only when no local lock users can exist. + * + * @param cpp + * NFP CPP handle + * @param target + * NFP CPP target ID (ie NFP_CPP_TARGET_CLS or NFP_CPP_TARGET_MU) + * @param address + * Offset into the address space of the NFP CPP target ID + * + * @return + * - (0) if the lock was OK + * - (1) if locked by us + * - (-errno) on invalid mutex + */ +int +nfp_cpp_mutex_reclaim(struct nfp_cpp *cpp, + int target, + uint64_t address) +{ + int err; + uint32_t tmp; + uint16_t interface = nfp_cpp_interface(cpp); + const uint32_t mur = NFP_CPP_ID(target, 3, 0); /* atomic_read */ + const uint32_t muw = NFP_CPP_ID(target, 4, 0); /* atomic_write */ + + err = nfp_cpp_mutex_validate(interface, &target, address); + if (err != 0) + return err; + + /* Check lock */ + err = nfp_cpp_readl(cpp, mur, address, &tmp); + if (err < 0) + return err; + + if (nfp_mutex_is_unlocked(tmp) || nfp_mutex_owner(tmp) != interface) + return 0; + + /* Bust the lock */ + err = nfp_cpp_writel(cpp, muw, address, nfp_mutex_unlocked(interface)); + if (err < 0) + return err; -exit: - return err; + return 1; } diff --git a/drivers/net/nfp/nfpcore/nfp_mutex.h b/drivers/net/nfp/nfpcore/nfp_mutex.h new file mode 100644 index 0000000000..a79490b4d6 --- /dev/null +++ b/drivers/net/nfp/nfpcore/nfp_mutex.h @@ -0,0 +1,25 @@ +/* SPDX-License-Identifier: BSD-3-Clause + * Copyright(c) 2023 Corigine, Inc. + * All rights reserved. + */ + +#ifndef __NFP_MUTEX_H__ +#define __NFP_MUTEX_H__ + +#include "nfp_cpp.h" + +struct nfp_cpp_mutex; + +int nfp_cpp_mutex_init(struct nfp_cpp *cpp, int target, + uint64_t address, uint32_t key_id); + +struct nfp_cpp_mutex *nfp_cpp_mutex_alloc(struct nfp_cpp *cpp, int target, + uint64_t address, uint32_t key_id); + +void nfp_cpp_mutex_free(struct nfp_cpp_mutex *mutex); +int nfp_cpp_mutex_lock(struct nfp_cpp_mutex *mutex); +int nfp_cpp_mutex_unlock(struct nfp_cpp_mutex *mutex); +int nfp_cpp_mutex_trylock(struct nfp_cpp_mutex *mutex); +int nfp_cpp_mutex_reclaim(struct nfp_cpp *cpp, int target, uint64_t address); + +#endif /* __NFP_MUTEX_H__ */ diff --git a/drivers/net/nfp/nfpcore/nfp_resource.c b/drivers/net/nfp/nfpcore/nfp_resource.c index 539eb69680..d59d2d6c1e 100644 --- a/drivers/net/nfp/nfpcore/nfp_resource.c +++ b/drivers/net/nfp/nfpcore/nfp_resource.c @@ -7,6 +7,7 @@ #include "nfp_crc.h" #include "nfp_logs.h" +#include "nfp_mutex.h" #include "nfp_target.h" #define NFP_RESOURCE_TBL_TARGET NFP_CPP_TARGET_MU