build/patch/kernel/archive/sunxi-6.2/patches.megous/media-ov5640-Fix-focus-commands-blocking-until-complete.patch

115 lines
2.7 KiB
Diff

From 33ec6031788a5be1af69b70ebe6ccd84d17dae7c Mon Sep 17 00:00:00 2001
From: Benjamin Schaaf <ben.schaaf@gmail.com>
Date: Mon, 22 Nov 2021 23:38:26 +1100
Subject: [PATCH 049/391] media: ov5640: Fix focus commands blocking until
complete
Previously setting the focus controls would block until the sensor
completed the focus routine.
---
drivers/media/i2c/ov5640.c | 67 ++++++++++----------------------------
1 file changed, 18 insertions(+), 49 deletions(-)
diff --git a/drivers/media/i2c/ov5640.c b/drivers/media/i2c/ov5640.c
index d67298018..bd8b4e94c 100644
--- a/drivers/media/i2c/ov5640.c
+++ b/drivers/media/i2c/ov5640.c
@@ -2610,6 +2610,19 @@ static int ov5640_copy_fw_to_device(struct ov5640_dev *sensor,
return -ETIMEDOUT;
}
+static int ov5640_fw_command(struct ov5640_dev *sensor, int command)
+{
+ int ret;
+
+ ret = ov5640_write_reg(sensor, OV5640_REG_FW_CMD_MAIN, command);
+ if(ret)
+ return ret;
+
+ msleep(5);
+
+ return 0;
+}
+
static int ov5640_af_init(struct ov5640_dev *sensor)
{
struct i2c_client *client = sensor->i2c_client;
@@ -2647,6 +2660,11 @@ static int ov5640_af_init(struct ov5640_dev *sensor)
// Set lens focus driver on
ret = ov5640_write_reg(sensor, OV5640_REG_VCM_CONTROL4, 0x3f);
+ if (ret)
+ return ret;
+
+ // Set the default focus zone
+ ret = ov5640_fw_command(sensor, OV5640_FW_CMD_ZONE_CONFIG);
if (ret)
return ret;
return ret;
@@ -3278,35 +3296,6 @@ static int ov5640_set_framefmt(struct ov5640_dev *sensor,
is_jpeg ? (BIT(5) | BIT(3)) : 0);
}
-static int ov5640_fw_command(struct ov5640_dev *sensor, int command)
-{
- u8 fw_ack;
- int i;
- int ret;
-
- ret = ov5640_write_reg(sensor, OV5640_REG_FW_CMD_ACK, 0x01);
- if(ret)
- return ret;
-
- ret = ov5640_write_reg(sensor, OV5640_REG_FW_CMD_MAIN, command);
- if(ret)
- return ret;
-
- for (i = 0; i < 100; i++) {
- ret = ov5640_read_reg(sensor, OV5640_REG_FW_CMD_ACK, &fw_ack);
- if (ret)
- return ret;
-
- if (fw_ack == 0){
- return ret;
- }
-
- msleep(50);
- }
- return -ETIMEDOUT;
-}
-
-
/*
* Sensor Controls.
*/
@@ -3442,26 +3431,6 @@ static int ov5640_set_ctrl_focus(struct ov5640_dev *sensor, int command)
return 0;
}
- if (command == OV5640_FW_CMD_RELEASE_FOCUS) {
- dev_dbg(&client->dev, "%s: Releasing autofocus\n",
- __func__);
- return ov5640_fw_command(sensor, OV5640_FW_CMD_RELEASE_FOCUS);
- }
-
- // Restart zone config
- ret = ov5640_fw_command(sensor, OV5640_FW_CMD_ZONE_CONFIG);
- if (ret)
- return ret;
-
- // Set default focus zones
- ret = ov5640_fw_command(sensor, OV5640_FW_CMD_DEFAULT_ZONES);
- if (ret)
- return ret;
-
- dev_dbg(&client->dev, "%s: Triggering autofocus\n",
- __func__);
-
- // Start focussing
return ov5640_fw_command(sensor, command);
}
--
2.35.3