From 2a36909a94be110c34128319536c1c595635aa2e Mon Sep 17 00:00:00 2001
From: Thomas Skibo <thomas-bsd@skibo.net>
Date: Mon, 1 Nov 2021 12:29:29 +0800
Subject: [PATCH] iicoc: fix repeated start

Reviewed by:	jrtc27, philip
MFC after:	3 days
Differential Revision:	https://reviews.freebsd.org/D32737
---
 sys/dev/iicbus/iicoc.c | 27 +++++++++++++++++----------
 1 file changed, 17 insertions(+), 10 deletions(-)

diff --git a/sys/dev/iicbus/iicoc.c b/sys/dev/iicbus/iicoc.c
index e243e7128be..f22878224c3 100644
--- a/sys/dev/iicbus/iicoc.c
+++ b/sys/dev/iicbus/iicoc.c
@@ -147,8 +147,8 @@ iicoc_init(device_t dev)
 	return ((value & OC_CONTROL_EN) == 0);
 }
 
-int
-iicoc_iicbus_start(device_t dev, u_char slave, int timeout)
+static int
+iicoc_iicbus_start_common(device_t dev, u_char slave, int timeout, bool repeat)
 {
 	int error = IIC_EBUSERR;
 	struct iicoc_softc *sc;
@@ -158,7 +158,7 @@ iicoc_iicbus_start(device_t dev, u_char slave, int timeout)
 	sc->i2cdev_addr = (slave >> 1);
 
 	/* Verify the bus is idle */
-	if (iicoc_wait_on_status(dev, OC_STATUS_BUSY) < 0)
+	if (!repeat && iicoc_wait_on_status(dev, OC_STATUS_BUSY) < 0)
 		goto i2c_stx_error;
 
 	/* Write Slave Address */
@@ -186,6 +186,20 @@ iicoc_iicbus_start(device_t dev, u_char slave, int timeout)
 	return (error);
 }
 
+int
+iicoc_iicbus_start(device_t dev, u_char slave, int timeout)
+{
+
+	return (iicoc_iicbus_start_common(dev, slave, timeout, false));
+}
+
+int
+iicoc_iicbus_repeated_start(device_t dev, u_char slave, int timeout)
+{
+
+	return (iicoc_iicbus_start_common(dev, slave, timeout, true));
+}
+
 int
 iicoc_iicbus_stop(device_t dev)
 {
@@ -268,10 +282,3 @@ iicoc_iicbus_reset(device_t dev, u_char speed, u_char addr, u_char *oldadr)
 	mtx_unlock(&sc->sc_mtx);
 	return (error);
 }
-
-int
-iicoc_iicbus_repeated_start(device_t dev, u_char slave, int timeout)
-{
-
-	return 0;
-}
-- 
2.45.2