Received-SPF: pass (google.com: domain of linux-kernel-owner@vger.kernel.org designates 2620:137:e000::1:20 as permitted sender) client-ip=2620:137:e000::1:20;
From:   Chester Lin <clin@suse.com>
To:     Linus Walleij <linus.walleij@linaro.org>,
        Andy Shevchenko <andy.shevchenko@gmail.com>
Cc:     Chester Lin <clin@suse.com>, NXP S32 Linux Team <s32@nxp.com>,
        linux-gpio@vger.kernel.org, linux-kernel@vger.kernel.org,
        linux-arm-kernel@lists.infradead.org,
        Ghennadi Procopciuc <Ghennadi.Procopciuc@oss.nxp.com>,
        Andrei Stefanescu <andrei.stefanescu@nxp.com>,
        Radu Pirea <radu-nicolae.pirea@nxp.com>,
        =?UTF-8?q?Andreas=20F=C3=A4rber?= <afaerber@suse.de>,
        Matthias Brugger <mbrugger@suse.com>
Subject: [PATCH v3 3/6] pinctrl: s32cc: refactor pin config parsing
Date:   Thu, 23 Mar 2023 22:48:30 +0800
Message-Id: <20230323144833.28562-4-clin@suse.com>
In-Reply-To: <20230323144833.28562-1-clin@suse.com>
References: <20230323144833.28562-1-clin@suse.com>
Content-Transfer-Encoding: 8bit
Content-Type: text/plain
MIME-Version: 1.0
X-MS-Exchange-AntiSpam-MessageData-ChunkCount: 1
X-MS-Exchange-AntiSpam-MessageData-0: =?us-ascii?Q?bOBLIp5xZ2Imd6GelnGUa671DPPQCnjBJFisr1xS59uwFangYhTTMhsuImeh?=
 =?us-ascii?Q?zlfUOIGRswrlUywDYBhTKuZoFk0X3S7f+w1RY2LeMlgk/RSlAAV9sj2ix7iP?=
 =?us-ascii?Q?mZGn/4hsGARUPx7M5ze0jgb5edNQRnES3Uq8rHlHnzyhyiSjm+W4N8DtCEFO?=
 =?us-ascii?Q?jqbQnEACa4Dv4NXYnvgvqb7YLmOK1ZTUCtlJsPF+/zs9Xdo02CmcuHxRqMfY?=
 =?us-ascii?Q?h17QTA6VNW+MqhYrfp9k1Fvg8EIpDeoOMIpXQ2L1YkWBgzacAfLF01KrzXZy?=
 =?us-ascii?Q?nPmuQR5uPDl1jdrDOXKqgVodVk2rLjuvXCf1P1ai0Uf+GVmFIzm7suoPwHiW?=
 =?us-ascii?Q?/khiqY+kvxX8lYNAK0AZzjZpqKcPkXlbb2HkttC2I39hflBiIrIBcoikeHwz?=
 =?us-ascii?Q?Bh0CJ+LLTTUiBjf1HPXVc9AG0cHFKKU+gsXLbVZW6VVS60qI50/Nlc+KM4k1?=
 =?us-ascii?Q?4x8ATfSHI0ERblv3ImeQLBClz7KzVBK1Wm5PBeSrxlrtg0acx6flshukCFzz?=
 =?us-ascii?Q?ixw8lTpeOSwFXjFeUNfx8gNU/UHASt175fYY2y30+jodJutbAo8PQqF4UlZN?=
 =?us-ascii?Q?VGj3HqVY0uKtU7P5cOCHK6fJumxrknfsPGBouhTxi0M0ETea9jl8rSoU2+YS?=
 =?us-ascii?Q?Lm+JTAMmx+/IPmBrznTjuQYj+CRuSQ/uLEXswJuun8SYoJon4ssQgrwOQsV0?=
 =?us-ascii?Q?zGYtzT5EQMfXaIqNcCBBNeUL564VT1URvS0lBwskdFj8xH5rPwFdUiu6KIkt?=
 =?us-ascii?Q?P2w3U9gErX1lxY88uYLklgB9gTIeOSEMSi878G1sFl+ZArEoQ9j+/IOgC8/1?=
 =?us-ascii?Q?cNvEIDZTlRSJbJTIyrRQnv3jC0PJ0YkkiLU9Kl/uybqTWqyFI7Oq+VkJ304R?=
 =?us-ascii?Q?Fl2B7Vro+uDiKloqlCU3yOKWQeUAezX1s5jK3dWlh/v4sjF9S6UScgB0V0kb?=
 =?us-ascii?Q?/6GrJu4zrRl4U0d2oqyxxZ1hCKoTk/xK6pjMAGXfzNlOzQ01ETJNmhtdJ/k3?=
 =?us-ascii?Q?FUXYDmgFg/LBfYNOXzrypMn0FlFCcu2GSTEXW+pxPeuxz294hExthYNVgqRN?=
 =?us-ascii?Q?vaU7LbP4QyPnzDoE6rXucuphRDFYy9WVD/TMlSgXDQ1y15gmapvLEwg1Nj34?=
 =?us-ascii?Q?GQQNIouokFwebgjXJx2QhkdfV3UEVFeGtv+svh8rZY6PE1wcIp2O71fU7lHA?=
 =?us-ascii?Q?Bzq+llvE59UUERTtMmDBfT8wpKP8ZkelQAYIuSNqVZSJuGy5nyQ9iSjE949J?=
 =?us-ascii?Q?Lri4J//vp40/SWLpoWn/wIdZ405oPVWEkzTzi5QB7zOjnhlnEFixJRzTeJsa?=
 =?us-ascii?Q?4PYPW3xMdwkuHeBbkgPCAp21uGh9HqRsKC7tYibYVCTNQPpF27clHpUrhc2C?=
 =?us-ascii?Q?G15OWPokk6pa8jH1nahRfwJXmYUftr53EYnNx6D2gPLs4ogYPGUiz2WypKP2?=
 =?us-ascii?Q?mASFZHYQ6aOH7ZgSdwd60dWPF1n2F40LnU1erNBOibAFrwWgtA9PNsvsXYdI?=
 =?us-ascii?Q?DFxg/knt1Ct7FeX74iNSOhxjYT8KOjuMQqV8YTBFkQCIxe1+gapQmf3Bx+Yc?=
 =?us-ascii?Q?KNG64PNRusDnadIcS/s=3D?=
X-OriginatorOrg: suse.com
X-MS-Exchange-CrossTenant-Network-Message-Id: f59b9066-3cd0-4ac1-1d62-08db2badcd16
X-MS-Exchange-CrossTenant-AuthSource: VI1PR0402MB3439.eurprd04.prod.outlook.com
X-MS-Exchange-CrossTenant-AuthAs: Internal
X-MS-Exchange-CrossTenant-OriginalArrivalTime: 23 Mar 2023 14:49:27.4422
 (UTC)
X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted
X-MS-Exchange-CrossTenant-Id: f7a17af6-1c5c-4a36-aa8b-f5be247aa4ba
X-MS-Exchange-CrossTenant-MailboxType: HOSTED
X-MS-Exchange-CrossTenant-UserPrincipalName: PMQ8ocR7io/rOc7wIHJg5tJeCZEfm/UZY1FzUvuGt1yZ+x6nHUMg3Za8q96f3GES
X-MS-Exchange-Transport-CrossTenantHeadersStamped: AS8PR04MB7544
X-Spam-Status: No, score=-0.2 required=5.0 tests=DKIM_SIGNED,DKIM_VALID,
        DKIM_VALID_AU,DKIM_VALID_EF,RCVD_IN_DNSWL_NONE,RCVD_IN_MSPIKE_H2,
        SPF_HELO_PASS,SPF_PASS autolearn=unavailable autolearn_force=no
        version=3.4.6
X-Spam-Checker-Version: SpamAssassin 3.4.6 (2021-04-09) on
        lindbergh.monkeyblade.net
Precedence: bulk
List-ID: <linux-kernel.vger.kernel.org>
X-Mailing-List: linux-kernel@vger.kernel.org

Move common codes into smaller inline functions and remove argument checks
that are not actually used by pull up/down bits in S32 MSCR register.

Signed-off-by: Chester Lin <clin@suse.com>
---
Changes v3:
- Move the PIN_CONFIG_BIAS_DISABLE case to be with PU and PD cases since
  they have the same function call.
- Roll back the argument checks of OUTPUT_ENABLE and INPUT_ENABLE cases
  since they were wrongly removed with the PU & PD parts in v2.

 drivers/pinctrl/nxp/pinctrl-s32cc.c | 52 ++++++++++++++++++-----------
 1 file changed, 33 insertions(+), 19 deletions(-)

diff --git a/drivers/pinctrl/nxp/pinctrl-s32cc.c b/drivers/pinctrl/nxp/pinctrl-s32cc.c
index f698e1a240ef..36f323f87785 100644
--- a/drivers/pinctrl/nxp/pinctrl-s32cc.c
+++ b/drivers/pinctrl/nxp/pinctrl-s32cc.c
@@ -474,11 +474,38 @@ static int s32_get_slew_regval(int arg)
 	return -EINVAL;
 }
 
-static int s32_get_pin_conf(enum pin_config_param param, u32 arg,
-			    unsigned int *mask, unsigned int *config)
+static inline void s32_pin_set_pull(enum pin_config_param param,
+				   unsigned int *mask, unsigned int *config)
 {
+	switch (param) {
+	case PIN_CONFIG_BIAS_DISABLE:
+	case PIN_CONFIG_BIAS_HIGH_IMPEDANCE:
+		*config &= ~(S32_MSCR_PUS | S32_MSCR_PUE);
+		break;
+	case PIN_CONFIG_BIAS_PULL_UP:
+		*config |= S32_MSCR_PUS | S32_MSCR_PUE;
+		break;
+	case PIN_CONFIG_BIAS_PULL_DOWN:
+		*config &= ~S32_MSCR_PUS;
+		*config |= S32_MSCR_PUE;
+		break;
+	default:
+		return;
+	}
+
+	*mask |= S32_MSCR_PUS | S32_MSCR_PUE;
+}
+
+static int s32_parse_pincfg(unsigned long pincfg, unsigned int *mask,
+			    unsigned int *config)
+{
+	enum pin_config_param param;
+	u32 arg;
 	int ret;
 
+	param = pinconf_to_config_param(pincfg);
+	arg = pinconf_to_config_argument(pincfg);
+
 	switch (param) {
 	/* All pins are persistent over suspend */
 	case PIN_CONFIG_PERSIST_STATE:
@@ -508,26 +535,15 @@ static int s32_get_pin_conf(enum pin_config_param param, u32 arg,
 		*config |= S32_MSCR_SRE((u32)ret);
 		*mask |= S32_MSCR_SRE(~0);
 		break;
+	case PIN_CONFIG_BIAS_DISABLE:
 	case PIN_CONFIG_BIAS_PULL_UP:
-		if (arg)
-			*config |= S32_MSCR_PUS;
-		else
-			*config &= ~S32_MSCR_PUS;
-		fallthrough;
 	case PIN_CONFIG_BIAS_PULL_DOWN:
-		if (arg)
-			*config |= S32_MSCR_PUE;
-		else
-			*config &= ~S32_MSCR_PUE;
-		*mask |= S32_MSCR_PUE | S32_MSCR_PUS;
+		s32_pin_set_pull(param, mask, config);
 		break;
 	case PIN_CONFIG_BIAS_HIGH_IMPEDANCE:
 		*config &= ~(S32_MSCR_ODE | S32_MSCR_OBE | S32_MSCR_IBE);
 		*mask |= S32_MSCR_ODE | S32_MSCR_OBE | S32_MSCR_IBE;
-		fallthrough;
-	case PIN_CONFIG_BIAS_DISABLE:
-		*config &= ~(S32_MSCR_PUS | S32_MSCR_PUE);
-		*mask |= S32_MSCR_PUS | S32_MSCR_PUE;
+		s32_pin_set_pull(param, mask, config);
 		break;
 	default:
 		return -EOPNOTSUPP;
@@ -553,9 +569,7 @@ static int s32_pinconf_mscr_update(struct pinctrl_dev *pctldev,
 		pin_get_name(pctldev, pin_id), num_configs);
 
 	for (i = 0; i < num_configs; i++) {
-		ret = s32_get_pin_conf(pinconf_to_config_param(configs[i]),
-				       pinconf_to_config_argument(configs[i]),
-				       &mask, &config);
+		ret = s32_parse_pincfg(configs[i], &mask, &config);
 		if (ret)
 			return ret;
 	}
-- 
2.37.3