From 041a93502b993b0f50fe4406aa1033a07b22ae07 Mon Sep 17 00:00:00 2001 From: iabdalkader Date: Sat, 23 Sep 2017 15:45:54 +0200 Subject: [PATCH] Update SCCB probe function. --- src/omv/sccb.c | 16 +++++++--------- 1 file changed, 7 insertions(+), 9 deletions(-) diff --git a/src/omv/sccb.c b/src/omv/sccb.c index 1aa40d438..6ca3f3adf 100644 --- a/src/omv/sccb.c +++ b/src/omv/sccb.c @@ -42,19 +42,17 @@ int SCCB_Init() uint8_t SCCB_Probe() { - uint8_t reg = 0x00; - uint8_t slv_addr = 0x00; - + uint8_t reg = 0; for (int i=0; i<127; i++) { + __disable_irq(); if (HAL_I2C_Master_Transmit(&I2CHandle, i, ®, 1, TIMEOUT) == HAL_OK) { - slv_addr = i; - break; - } - if (i!=126) { - systick_sleep(1); // Necessary for OV7725 camera (not for OV2640). + __enable_irq(); + return i; } + __enable_irq(); + systick_sleep(1); } - return slv_addr; + return 0; } uint8_t SCCB_Read(uint8_t slv_addr, uint8_t reg)