1 files changed, 63 insertions, 0 deletions

diff --git a/lib/chibios-contrib/ext/mcux-sdk/components/video/camera/device/sccb/fsl_sccb.c b/lib/chibios-contrib/ext/mcux-sdk/components/video/camera/device/sccb/fsl_sccb.c
new file mode 100644
index 000000000..2e6a3f4d1
--- /dev/null
+++ b/lib/chibios-contrib/ext/mcux-sdk/components/video/camera/device/sccb/fsl_sccb.c
@@ -0,0 +1,63 @@
+/*
+ * Copyright 2017-2018, 2020 NXP
+ * All rights reserved.
+ *
+ *
+ * SPDX-License-Identifier: BSD-3-Clause
+ */
+
+#include "fsl_common.h"
+#include "fsl_sccb.h"
+
+/*******************************************************************************
+ * Definitions
+ ******************************************************************************/
+
+/*******************************************************************************
+ * Code
+ ******************************************************************************/
+
+status_t SCCB_WriteReg(
+    uint8_t i2cAddr, sccb_reg_addr_t addrType, uint32_t reg, uint8_t value, sccb_i2c_send_func_t i2cSendFunc)
+{
+    return i2cSendFunc(i2cAddr, reg, addrType, &value, 1);
+}
+
+status_t SCCB_WriteMultiRegs(uint8_t i2cAddr,
+                             sccb_reg_addr_t addrType,
+                             uint32_t startReg,
+                             const uint8_t *value,
+                             uint32_t len,
+                             sccb_i2c_send_func_t i2cSendFunc)
+{
+    return i2cSendFunc(i2cAddr, startReg, addrType, value, len);
+}
+
+status_t SCCB_ReadReg(
+    uint8_t i2cAddr, sccb_reg_addr_t addrType, uint32_t reg, uint8_t *value, sccb_i2c_receive_func_t i2cReceiveFunc)
+{
+    return i2cReceiveFunc(i2cAddr, reg, addrType, value, 1);
+}
+
+status_t SCCB_ModifyReg(uint8_t i2cAddr,
+                        sccb_reg_addr_t addrType,
+                        uint32_t reg,
+                        uint8_t clrMask,
+                        uint8_t value,
+                        sccb_i2c_receive_func_t i2cReceiveFunc,
+                        sccb_i2c_send_func_t i2cSendFunc)
+{
+    status_t status;
+    uint8_t regVal = 0U;
+
+    status = SCCB_ReadReg(i2cAddr, addrType, reg, &regVal, i2cReceiveFunc);
+
+    if (kStatus_Success != status)
+    {
+        return status;
+    }
+
+    regVal = (uint8_t)(regVal & ~((uint32_t)clrMask)) | (value & clrMask);
+
+    return SCCB_WriteReg(i2cAddr, addrType, reg, regVal, i2cSendFunc);
+}