diff mbox series

[-next] i2c: designware: Add helper to remove redundancy

Message ID 20220310142236.192811-1-jsd@semihalf.com
State New
Headers show
Series [-next] i2c: designware: Add helper to remove redundancy | expand

Commit Message

Jan Dąbroś March 10, 2022, 2:22 p.m. UTC 
Simplify code by adding an extra static function for sending I2C
requests and verifying results.

Signed-off-by: Jan Dabros <jsd@semihalf.com>
---
 drivers/i2c/busses/i2c-designware-amdpsp.c | 44 ++++++++++++----------
 1 file changed, 24 insertions(+), 20 deletions(-)
diff mbox series

Patch

diff --git a/drivers/i2c/busses/i2c-designware-amdpsp.c b/drivers/i2c/busses/i2c-designware-amdpsp.c
index c64e459afb5c..cc758792f150 100644
--- a/drivers/i2c/busses/i2c-designware-amdpsp.c
+++ b/drivers/i2c/busses/i2c-designware-amdpsp.c
@@ -229,6 +229,26 @@  static int psp_send_i2c_req(enum psp_i2c_req_type i2c_req_type)
 	return ret;
 }
 
+static int psp_send_i2c_req_check_err(enum psp_i2c_req_type request)
+{
+	int status;
+
+	status = psp_send_i2c_req(request);
+	if (status) {
+		if (status == -ETIMEDOUT)
+			dev_err(psp_i2c_dev, "Timed out waiting for PSP to %s I2C bus\n",
+				(request == PSP_I2C_REQ_ACQUIRE) ?
+				"release" : "acquire");
+		else
+			dev_err(psp_i2c_dev, "PSP communication error\n");
+
+		dev_err(psp_i2c_dev, "Assume i2c bus is for exclusive host usage\n");
+		psp_i2c_mbox_fail = true;
+	}
+
+	return status;
+}
+
 static int psp_acquire_i2c_bus(void)
 {
 	int status;
@@ -248,17 +268,9 @@  static int psp_acquire_i2c_bus(void)
 		goto cleanup;
 	};
 
-	status = psp_send_i2c_req(PSP_I2C_REQ_ACQUIRE);
-	if (status) {
-		if (status == -ETIMEDOUT)
-			dev_err(psp_i2c_dev, "Timed out waiting for PSP to release I2C bus\n");
-		else
-			dev_err(psp_i2c_dev, "PSP communication error\n");
-
-		dev_err(psp_i2c_dev, "Assume i2c bus is for exclusive host usage\n");
-		psp_i2c_mbox_fail = true;
+	status = psp_send_i2c_req_check_err(PSP_I2C_REQ_ACQUIRE);
+	if (status)
 		goto cleanup;
-	}
 
 	psp_i2c_sem_acquired = jiffies;
 	psp_i2c_access_count++;
@@ -293,17 +305,9 @@  static void psp_release_i2c_bus(void)
 		goto cleanup;
 
 	/* Send a release command to PSP */
-	status = psp_send_i2c_req(PSP_I2C_REQ_RELEASE);
-	if (status) {
-		if (status == -ETIMEDOUT)
-			dev_err(psp_i2c_dev, "Timed out waiting for PSP to acquire I2C bus\n");
-		else
-			dev_err(psp_i2c_dev, "PSP communication error\n");
-
-		dev_err(psp_i2c_dev, "Assume i2c bus is for exclusive host usage\n");
-		psp_i2c_mbox_fail = true;
+	status = psp_send_i2c_req_check_err(PSP_I2C_REQ_RELEASE);
+	if (status)
 		goto cleanup;
-	}
 
 	dev_dbg(psp_i2c_dev, "PSP semaphore held for %ums\n",
 		jiffies_to_msecs(jiffies - psp_i2c_sem_acquired));